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ABSTRACT 


Historically,  vehicle-borne,  radio-hybrid  navigation  system  software 
has  too  often  been  designed  around  preselected  navigation  hardware  on  an 
ad  hoc,  system-by-system  basis.  In  these  developments,  little  attention 
has  been  paid  to  the  inherent  physical  and  functional  commonality  which 
underlies  much  of  this  superficially  quite  different  software.  This 
report  documents  the  methods,  and  the  very  promising  results,  of  the 
second  phase  of  a  software  development  effort  directed  at  identifying 
and  specifying  a  standardized,  modular,  flexible,  radio-hybrid  navigation 
system  software  processor. 

The  machine-and.-language-independent  (MLI)  processor  specification 
which  has  in  particular  been  developed  to  date  has  been  designed  so 
that  --  with  appropriate,  minor,  system-specific  tailoring  --  it  can 
serve  as  the  basic  specification  for  the  navigation  software  development 
for  any  specific  system,  within  a  wide  range  of  navigation  hardware 
equipment  configurations  and  mission  requirements.  These  currently 
include  any  combination  of  radio  (LOS  or  earth  mode),  inertial,  AHRS , 
and  CADS  navigation  equipments,  as  well  as  the  requirements  associated 
with  most  military  and  civil  aircraft  missions  and  usages.  In  addition, 
the  MLI  processor  has  been  carefully  structured  to  allow  for  easy  accom¬ 
modation  of  additional  navigation  hardware  processing  requirements. 

The  second-phase  effort  used  as  its  point  of  departure  and  develop¬ 
mental  framework  the  basic  guidelines,  concepts  and  algorithms  established 
in  the  initial  phase.  These  include,  in  particular,  the  exclusive  use  of 
vector-matrix  algorithm  formulations,  processor  organization  into  basic, 
building-block  function-  and  hardware-specific  modules  and  submodules, 
the  use  of  a  single,  mission-phase  switchable,  computational  reference 
frame,  and  the  use  of  partitioned,  modularly  organized  Kalman  filtering 
techniques.  The  overall  second-phase  effort  itself  consisted  of  two 
main,  more  or  less  sequential  developments;  (a)  the  extension  and  re¬ 
finement  of  the  MLI  processor  capabilities  beyond  its  first-phase  level, 
and  (b)  the  initial  development  of  a  specialized,  higher-order  language 
navigation  program  using  the  MLI  processor  specification  as  a  basis. 

The  improvements  of  the  MLI  processor  accomplished  in  the  second 
phase  included  (a)  extension  of  its  navigation  hardware  applicability 
to  allow  use  of  cheaper  AHRU/CADS  equipment,  either  in  lieu  of  or  as 
a  backup  to  an  IMU;  (b)  further  development  and  refinement  of  a  novpl 
and  promising  radio-autonomous  navigation  technique;  (c)  extension  and 
refinement  of  processor  and  navigation  equipment  initialization  and 
alignment  techniques;  (d)  development  of  a  completely  partitioned  and 
modularized  Kalman  filter;  and  (e)  development  of  a  complete  set  of 
processor  mode  control  and  switching  logic  specifications.  In  particular, 
one  of  the  initialization  algorithms  developed  is  a  new  and  powerful  one 
which  allows  undegraded  Kalman  filter  use  of  radio  pseudoranging  measure¬ 
ments,  despite  large  LOS  directional  uncertainties.  Further,  the  Kalman 
filter  partitioned  modularity  was  achieved  without  artificial  (and  per¬ 
formance-degrading)  decoupling  of  interpartition  system  error  dynamics. 
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Time  and  money  constraints  permitted  development  of  the  specialized 
FORTRAN  IV/IBM  370  processor  program  only  to  a  very  limited  stage.  Specif¬ 
ically,  all  the  principal  navigation  modules  required  for  a  single  assumed 
LOS/inertial  navigation  hardware  configuration  and  navigation  mode  of 
operation  have  been  programmed  and  checked  out  (for  fixed  inputs  only); 
no  mode  switching  or  control  modules  have  been  programmed.  However,  even 
this  limited  level  of  development  was  intended  (and  has  served)to  accom¬ 
plish  two  purposes.  First,  it  provided  a  learn-by-doing  vehicle  for  the 
broadly  experienced  programmer  assigned  the  task,  to  assay  the  viability 
of  the  MLI  processor  specifications  from  the  standpoint  of  real-time  pro¬ 
gramming  in  either  an  HOL  or  a  machine-specific  language.  The  preliminary 
conclusions  reached  in  this  regard  are  that  the  MLI  specification  provides 
the  programmer  with  an  extremely  flexible  and  easily  modifiable,  but 
standardized  approach  to  programming  real-time,  multisensor,  Kalman  (or 
non-Kalman)  navigation  system  software  for  any  airborne  digital  computer. 

In  addition,  it  places  overall  program  efficiency  and  balance  (with  regard 
to  execution  time  and  memory  requirements)  much  more  completely  under  the 
control  of  the  programmer  than  traditional  types  of  specification. 

The  second  purpose  accomplished  lies  in  the  fact  that  the  programmed 
modules  thus  far  developed  constitute  a  nucleus-in-being  for  further  devel¬ 
opment  of  either  a  processor  evaluation  simulation  program  on  the  one  hand, 
or  a  standardized,  real-time  HOL  master  navigation  program  for  subsequent 
machine-specific  translation,  on  the  other. 
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Frame  Definition 

▲  JS  A 

Earth  centered,  non-rotating  w/r  to  fixed 
stars.  1^  ■  earth's  north  polar  axis  dl* 
rectlon,  *  normal  to  fj  in  direction  of 
point  of  Arles,  ^  ^  *  fj‘ 

I 

V  V  X3 

E 

e,.  f2.  r, 

A  A  A 

Earth  centered,  earth-fixed,  t.  -  f. , 

*  *  11 

E,  -  normal  to  E  in  plane  of  Cnvch  Merl- 

dian,  Ej  »  Ej  x 

P 

pr  p2.  p3 

▲  A 

Platform  reference  frame.  Center  at  cen¬ 
ter  of  rotation  of  platform  (for  glmballed 
or  floated  platform),  or  at  defined  point 

in  platform  (for  strapdown  platform). 

*  *  * 

Orthogonal  P^,  ?2,  Pj  directions  fixed  in 
platform 

A 

^1 1  *2 1  *3 

^  ▲  a 

Airframe  frame.  Concentric  with  P  frame. 
Orthogonal  Aj,  A2,  A^  directions  fixed  in 
slrcrsft. 

L 

Lr  V  4 

a  a  a 

Local  geographic  vertical,  wander  azimuth 

a 

frame.  Concentric  with  P  frame.  L.  «  up, 

j»  j.  *  l 

Lg  and  L^  normal  to  and  each  other. 

C 

cr  c2  *  c3 

Computational  (Computer)  frame.  May  be  any 
of  the  other  frames  defined  hare,  as  speci¬ 
fied  (C  frame  subscrlptlnc  is  often  omitted 

for  compactness  of  axpresslon) 

;  if 
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1.  COORDINATE  REFERENCE  FRAME  (Continued) 


Symbol 

Unit  Vectors 

Frame  Definition 

EF 

ef1,ef2,ef3 

Earth-fixed,  but  not  necessarily  earth- 
centered  frame,  (e.g.  .local  tangent  plane 

frame). 

AEM 

AEMltAEM2,AEM3 

Emitter  air  frame;  centered  at  emitter 

2.  INTERFRAME  RELATIONSHIPS 


Symbol 

Def init ion 

TF2/F1 

Orthonormal  3x3  matrix  transformation  from 

frame  FI  to  frame  F2 

<aF2/F1 

Vector  angular  rate  of  frame  F2  w/r  to  frame  FI 

3.  BASIC  NAVIGATION  DISPLACEMENT  VECTORS 


Vector 

Symbol 

Displacement  Vector  Definition 

P-PE 

Position  vector  from  center  of  earth  to  center  of  P  frame. 

E 

Position  vector  from  center  of  earth  to  center  of  EM  frame. 

R 

Estimated  LOS  range  vector  (■  p-e  »  P-E) 

R  * 

m 

Measured  LOS  range  scalar 

C 

Position  vector  from  center  of  earth  to  center  of  EF  frame. 

P 

Position  vector  from  center  of  EF  frame  to  center  of  P  frame. 

e 

Position  vector  from  center  of  EF  frame  to  center  of  EM  frame. 

♦scalar 
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3.  BASIC  NAVIGATION  DISPLACEMENT  VECTORS  (Continued) 


Vector 

Symbol 

Displacement  Vector  Definition 

\ 

Position  vector  from  center  of  earth  to  the  subaircraft 
surface  ellipsoid  point. 

E 

s 

Position  vector  from  center  of  earth  to  Che  subemitter 
surface  ellipsoid  point. 

A 

Position  vector  from  center  of  earth  to  center  of  user 
antenna . 

a 

Position  vector  from  center  of  EF  frame  to  center  of  user 
antenna. 

Position  vector  from  center  of  P  frame  to  center  of  user 
antenna. 

dEM 

Position  vector  from  center  of  emitter  frame  to  center  of 
emitter  antenna 

r 

Unit  LOS  range  vector 

T 

Unit  earth  mode  range  vector  (user  end) 

tem 

Unit  earth  mode  range  vector  (emitter  end) 

4.  ALTITUDE  SCALARS 


Symbol 

Altitude  Definitions 

h  ♦ 

User  altitude  scalar. 

h  ♦ 

EM 

Emitter  altitude  scalar. 

♦scalars 


5.  VELOCITY  AND  ACCELERATION  VECTORS 


Vector 

Symbol 

Vector  Definition 

V 

Velocity  of  center  of  P  frame  with  respect  to  the  earth  (i.e., 
with  respect  to  the  E  or  EF  frames) 

VEM,6 

Velocity  of  center  of  EM  frame  with  respect  to  the  earth 

“te/Fl 

Angular  rate  of  frame  F2  with  respect  to  frame  FI. 

f 

Specific  force  acting  on  aircraft  (taken  to  act  at  center  of 

P  frame) 

G(P) 

Sum  of  all  celestial  mass  attraction  gravitation  accelera¬ 
tions  acting  on  aircraft  (taken  to  act  at  center  of  P  frame) 
minus  same  sum  acting  at  center  of  earth. 

g(P) 

G(P) ,  plus  centripetal  acceleration  at  center  of  P  frame  due 
to  rotation  of  the  earth. 

V 

w 

Wind  velocity  vector 

(ft 

< 

> 

Airspeed  velocity  vector 

» 

Maneuver  acceleration  vector 

6.  OPERATORS 

Operator 

Symbol 

Operator  Definition 

Time  rate  of  change  of  any  vector  a  w/r  to  frame  F  (F 

dt 

subscript  optional). 

(«x)F 

Cross ^product  matrix  associated  with  any  vector  a  in  frame  f. 

W 

Length  of  any  vector  a. 

Estimated  value  of  any  vector  a.  of  any  matrix  T,  of  any 

scalar  s 

V 

Change  in  a  in  the  basic  computational  Interval  At. 

Integral  of  a  over  the  Interval  t  to  t  +  At. 

t 

l 


6.  OPERATORS  (Continued) 


Operator 

Symbol 

Operator  Definition 

E 

Signal  addition  and/or  subtraction 

/ 

Signal  integration 

6a 

Error  in  computed  vector  a 

a,T,I 

Time  average  of  any  vector  a,  of  any  matrix  T,  of  any  scalar  s 

T 

Superscript  indicating  matrix  transposition 

7.  KALMAN  FILTER  VECTORS  AND  MATRICES 
See  Table  XXXIII,  page  138. 

8.  MODULE -SPECIFIC  VECTORS,  MATRICES,  SCALARS 

See  MLI  module  operations  summary  tables  (Section  III). 
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SECTION  I 


INTRODUCTION  AND  SUMMARY 


This  document  comprises  the  final  report  for  the  second  phase  of  the 
joint  Northrop  (prime  contractor) /Magnavox  (sole  subcontractor)  software 
development  effort  entitled  "Navigation  by  Multilateration  to  Fixed  and 
Moving  Reporting  Emitters,"  Project  No.  6095,  under  Contract  No.  F33615- 
72-C-1607.  However,  since  this  second  phase  consisted  in  large  part  of 
a  broadening,  deepening,  systematizing  and  programming  of  the  basic  con¬ 
cepts  formulated  in  the  initial  phase,  much  Phase  I  material  --  amended 
and/or  extended  as  necessary  --  has  been  included  to  make  this  report  as 
nearly  self-contained  as  practical.* 

The  principal  results  of  the  overall  (two-phase)  development  are: 

a)  ML I  Processor  Specification.  The  development  of  a  machine 

and  language-independent  (MLI)  specification  of  a  standardized, 
modular,  flexible,  multi-application,  radio-hybrid  navigation 
system  software  processor. 

b)  HOL  (FORTRAN  IV/IHM  370)  Version.  The  partial  development  of 
a  functionally  limited,  FORTRAN  IV/370  programmed  version  of 
the  above  processor. 

In  particular,  the  latter,  specialized  HOL  (higher  order  language) 
version  was  developed  using  the  former,  generalized  (and  even  higher  level 
language)  MLI  specification  as  a  basis.  Although  limited  in  both  function 
and  scope,  and  incomplete  (as  an  overall  navigation  processor),  the  HOL 
program  development  nevertheless  effectively  served  its  intended  purpose 
as  a  trial  horse  for  the  viability  of  the  MLI  specification  as  a  basis  for 
development  of  navigation  software  for  a  specific  application. 

The  report  is  organized  to  present  both  the  MLI  processor  specifica¬ 
tion  and  the  specialized  HOL  version  in  a  logically  sequential  manner, 
closely  paralleling  the  order  and  sequence  of  their  actual  development. 
Following  this  Introductory  section,  Section  II  presents  a  generalized 
description  of  the  processor  with  regard  to  its  scope  and  role,  its 
mission  and  hardware  applicability,  and  its  basic  structural  and  opera¬ 
tional  characteristics,  together  with  the  rationale  underlying  each  of 
aspects  and  features.  With  Section  II  as  a  background,  Section  III 
presents  the  detailed  modular  MLI  processor  specification  itself,  in  terms 
of  standardized,  module-by-module  operations  and  input/output  summary 


*However,  since  principal  emphasis  in  this  report  has  of  course  been  placed 
on  the  Phase  II  effort  in  particular,  the  Phase  I  Final  Report  (AFAL'TR* 
72*80,  May  1972)  can  and  should  serve  as  useful  background  reference 
material  for  this  document. 


tables,  and  summary  logic  flow  diagrams.  Finally,  Section  IV  presents  the 
MLI-based,  HOL  program  processor  version,  including  a  programmer-oriented 
description  as  well  as  the  actual  FORTRAN  program  listing.  Extensive 
appendices  are  included  at  the  end  of  the  report  as  detailed  and  appro¬ 
priate  backup  for  the  text  of  these  main  sections. 

Based  on  the  results  obtained  in  the  two-phase  processor  development 
to  date,  it  is  evident  that  the  MLI  specification  presented  in  this  docu¬ 
ment,  although  still  incomplete  in  some  regards,  already  constitutes  an 
extremely  powerful  tool  for  the  standardized  and  systematic  development 
of  modular,  flexible,  compact,  and  efficient  navigation  system  software, 
for  a  wide  range  of  specific  mission  applications  and  navigation  hardware 
configurations.  In  fact,  recognition  of  this  within  both  Northrop  and 
Magnavox  has  already  led  to  its  adoption  as  the  basic  navigation  software 
approach  for  several  applications,  at  both  the  proposal  and  contractual 
levels.  In  particular,  it  has  been  adopted  by  Northrop  for  its  use  in 
the  initial,  AFAL  MRV  hardware/software  configuration  definition  phase. 

Further,  it  is  also  already  evident  that  the  concepts  and  techniques 
employed  to  date  for  development  of  the  navigation-only  processor  presented 
here  can  probably  be  applied  nearly  intact,  not  only  to  development  of 
additional,  wholly  compatible  software  for  processing  types  of  navigation 
sensor  not  yet  specifically  considered  (e.g.,  doppler  radar,  DF  and  angula¬ 
tion  equipment,  etc.),  but  also  for  other,  non-navigation  but  navigation- 
related  avionics  software  (e.g.,  weapon  delivery,  steering,  guidance,  etc.). 
Overall,  this  suggests  the  extremely  attractive  possibility  that  in  the  not 
too  distant  future,  large  portions  of  the  overall  avionics  software  packages 
associated  not  only  with  a  single  weapons  system,  but  with  whole  classes  of 
weapons  systems,  may  be  developable  on  a  standardized,  modular,  partly  inter¬ 
changeable  basis.  Significant  overall  cost  savings,  both  developmental  and 
operational,  could  thereby  be  clearly  achieved. 

Finally,  it  should  also  be  noted  that  the  FORTRAN  IV  processor  version 
developed  to  date  constitutes  a  sizeable  nucleus-in-being  for  a  possible, 
general  processor  evaluation  simulation  program.  Such  a  program,  especially 
if  used  as  a  central  preliminary  and/or  an  adjunct  to  development  of  the 
standardized  avionics  software  mentioned  above,  would  quickly  pay  for  its 
development  cost  in  terms  of  avoidance  of  later  pitfalls  in  checkout  of 
the  actual  system  software,  when  the  design  has  hardened  and  is  difficult 
and  costly  to  change. 


SECTION  II 


PROCESSOR  DESCRIPTION 


This  section  presents  a  general  description  of  the  processor  evolved 
to  date  (i.e.,  as  presented  in  Section  III  of  this  report),  together  with 
the  rationale  which  underlay  its  development  into  this  form. 


1.  FUNCTIONAL  SCOPE  AND  ROLE 

Early  Phase  I  effort  was  mainly  concentrated  on  the  essential  pre- 
liminary  of  scoping  the  processor  to  be  developed  —  within  the  time  and 
level-of-effort  constraints  of  that  phase  --  so  as  to  provide  a  sound 
point  of  departure  for  subsequent  evolution  of  the  processor  in  later 
development  phases.  In  this  connection,  Figure  l  shows  the  overall  air¬ 
borne  avionics  equipments  data  processing  requirements  for  a  generic, 
aircraft  weapons  delivery  system.  In  this  diagram,  the  block  labeled 
navigation  processing  plays  a  central  role.  This  role  is  further  empha¬ 
sized  in  Figure  2,  which  compresses  all  the  required  processing  into  two 
areas:  basic  navigation  processing,  and  all  other  navigation  (or  navigation- 
related)  processing.  This  is  not  an  arbitrary,  but  rather  a  natural  and 
useful  division  of  the  overall  avionics  processing  requirements,  as  follows. 

The  meaning  of  the  basic  navigation  processing  intended  here  is  most 
easily  conveyed  in  terms  of  the  basic  outputs  --  i.e.,  user  vehicle  3*d 
position,  velocity,  attitude,  and  attitude  rate  --  it  produces.  Thus 
defined,  basic  navigation  processing  comprises  a  central  computational 
role,  with  respect  to  which  all  other  computations  are  peripheral  in  the 
sense  that  they  all  require  one  or  more  of  its  outputs  as  inputs,  while 
the  converse  is  not  true. 

To  clarify  this,  the  basic  navigation  processing  computations  require 
some  subset  of  data  only  from  the  IMU  (acceleration,  attitude  and,  if 
available,  attitude  rate),  the  AHRU  (attitude  and  attitude  rate),  the 
transceiver  (emitter  signal  phase  and  frequency  shift,  and,  when  reported, 
emitter  antenna  position  and  velocity),  ar.d  the  CADS  (altitude  and  true 
airspeed),  to  continuously  generate  all  the  basic  navigation  outputs,  as 
well  as  appropriate  IMU  control  and  transceiver  rate-aiding  signals.  On 
the  other  hand,  the  inputs  to  those  areas  of  the  overall  processing  which 
relate  to  control  of  all  other  onboard  avionics  hardware  equipments  can 
always  be  simply  derived  from  the  basic  navigation  outputs.  For  example, 
in  the  case  of  ILS,  the  required  inputs  might  typically  be  runway-relative, 
aircraft  horizontal  position,  horizontal  velocity,  altitude,  vertical 
velocity,  roll,  pitch,  heading,  and  turn  rate;  these  can  all  be  simply 
derived  from  the  basic  navigation  outputs,  if  they  are  expressed  in  a 
common  earth-fixed  reference  frame,  and  if  augmented  only  by  runway 
location  data  referenced  to  the  same  frame. 
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Phase  I  processor  functional  scope  was  therefore  limited  to  basic 
navigation  processing t  thus  defined,  to  enable  the  attainment  of  a  reason¬ 
able  first-stage  level  of  processor  definition,  within  the  constraints 
imposed  by  Phase  I  level-of-effort  and  duration. 

2.  MISSION /HARDWARE  APPLICABILITY 

Table  I  summarizes  in  broad  terms  the  results  of  a  brief  Phase  I 
survey  of  aircraft  missions  to  which  the  pi  .cessor  under  consideration 
here  might  apply.  Source  material  for  this  survey  included  government  and 
industry  sponsored  reports,  trade  periodicals,  and  consultation  with  mission 
requirements  specialists  at  Northrop  and  Magnavox. 

In  particular,  Table  I  shows  three  levels  of  accuracy  requirements  -- 
moderate  (about  1  mile  DRMS) ,  high  (a  few  hundred  feet,  DRMS) ,  and  very 
high  (under  one  hundred  feet,  DRMS)  --  for  a  wide  class  of  military  and  non- 
military  missions,  and  during  both  enroute  and  objective  area  phases  of  the 
mission.  In  general,  enroute  phase  accuracy  requirements  are  seen  to  be 
uniformly  moderate,  while  objective  area  requirements  range  from  moderate 
(e.g.,  for  near-destination  checkpoint  acquisition  in  an  intercontinental 
747  commercial  carrier  flight)  to  very  high  (e.g.,  for  an  A-7  close-support 
mission  in  zero  visibility). 

Table  I  also  summarizes  in  qualitative  terms  the  typical  maneuver 
profiles  for  the  same  broad  class  of  missions.  Again,  there  is  a  marked 
distinction  between  the  enroute  phase,  where  maneuvers  are  infrequent  and 
mild  (e.g.,  a  long-range  patrol  mission)  and  the  objective  area  phase, 
where  they  are  in  many  cases  frequent  and  violent  (e.g.,  ground  fire 
evasion  maneuvers  during  a  low-altitude,  tactical  observation  mission). 

Finally,  in  Table  I,  two  broad  classes  of  navigation  computation 
coordinate  system  --  geodetic  referenced  and  locally  referenced  --  are 
identified,  together  with  their  use  by  mission  and  mission  phase. 

The  geodetlcally  referenced  coordinate  systems,  which  are  most  fre¬ 
quently  used  and  useful  for  long-range,  point-to-point  navigation,  are 
referenced  to  earth-centered,  earth-fixed  frames  (e.g.,  the  unit  vector 
triad  composed  of  the  unit  vector  along  the  earth's  polar  axis,  and  two 
equatorial  plane  unit  vectors,  one  in  the  Greenwich  Meridian  plane,  and  the 
other  in  the  90"  Meridian  plane).  Typical  of  such  coordinate  systems  in 
common  use  are  latitude-longitude-altitude  (normal  and  transverse  polar), 
and  local  vertical  direction  coslnes-altltude. 

The  second  broad  class  -•  the  locally  referenced  coordinate  systems  -- 
are  most  frequently  used  for  short-range  point-to-point  navigation  and 
terminal  phase  operation  in  a  localized  (e.g.,  battlefield  or  theatre)  area. 
These  are  also  referenced  to  earth-fixed,  but  not  generally  earth-centered 
frames,  which  are  in  turn  tied  to  specific  ground  points  (e.g.,  a  bombing 
target  or  a  landing  field).  Typical  of  such  coordinate  systems  are  U1M 
coordinates,  and  tangent -plane,  target-centered  coordinates. 
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Each  of  these  coordinate  systems  has  its  peculiar  advantages  and 
disadvantages.  For  example,  the  latitude-longitude  approach  leads  to  the 
simplest  navigation  equations,  but  is  useless  near  the  poles,  while  the 
local  vertical  direction  cosine  approach  is  costlier  to  mechanize,  but 
automatically  provides  polar  navigation  capability.  Thus,  if  mission 
operations  were,  say,  limited  to  non-polar  regions,  the  former  might  be 
selected.  However,  if  the  objective  area  mission  Involved,  say,  an  air 
drop  with  respect  to  a  target-referenced  aim  point,  then  a  local  coordinate 
system  would  be  more  suitable  and  natural  for  navigation  in  this  phase  of 
the  mission. 

Typical  solutions  to  this  problem  --  the  necessity  for  navigating  in 
one  coordinate  system  enroute,  and  another  in  the  objective  area  --  have 
often  been  brute-force;  i.e.,  two  different  sets  of  navigation  equations 
are  mechanized,  one  for  each  phase,  and  both  sets  of  computations  are  run 
in  parallel  during  the  terminal  phase.  This  approach  tends  to  be  costly 
in  terms  of  airborne  computer  loading. 

These  mission  characteristics  and  requirements  --  i.e.,  accuracy, 
flight  profile,  and  coordinate  reference  frame  --  constitute  important 
constraints  on  the  design  of  a  generalized  processor  which  should  if  pos¬ 
sible  accommodate  the  entire  range  of  these  requirements.  The  ideas 
underlying  the  solutions  to  these  problems  are  discussed  In  subsection  3, 
which  deals  with  basic  processor  structural  and  operational  concepts. 

Determination  of  the  initial  processor  navigation  equipment  applica- 
baillty  list  was  governed  mainly  by  the  desire  for  full  processor  coverage, 
with  due  regard  to  both  accuracy  and  cost  requirements,  of  the  range  of 
missions  summarized  in  Table  I.  The  resulting  list  therefore  included: 

a.  IMU  (rotationally  isolated  or  strapdown) 

b.  AHRU 

c.  CADS 

d.  Radio  Transceiver (s)  (earth  mode  or  LOS,  one  way  or  two  way) 

In  addition,  although  specific  processing  capability  has  not  to  date 
been  Included  for  the  following  equipment  types,  careful  design  provision 
has  nevertheless  been  made  so  that  their  processing  can  easily  and  natu¬ 
rally  be  accommodated  by  simply  adding  for  each,  its  appropriate  hardware- 
specific  module: 

e.  Doppler  radar 

f.  Angular  tracking  equipment  (stellar,  optical,  etc.) 

g.  Terrain  matching  equipment. 
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3. 


BASIC  STRUCTURAL  AND  OPERATIONAL  CONCEPTS 


The  attainment  of  a  compact,  efficient,  and  flexible  processor  design,  in 
the  face  of  the  desired  broad  range  of  mission  and  hardware  applicability  out¬ 
lined  above,  required  early  Phase  I  consideration  of  a  variety  o i.  basic  design 
factors  which  are  discussed  in  paragraphs  a.  through  e.  below.  Against  this 
background,  paragraph  f.  then  presents  a  brief  summary  of  the  modular  organi¬ 
zation  actually  adopted  for  the  processor.  Finally,  paragraphs  g.  and  h.  deal 
respectively  with  certain  capabilities  of  special  interest  which  were  de¬ 
veloped  and  embedded  in  the  processor  design  during  the  program,  and  a  brief 
discussion  of  the  growth  potential  also  embedded  in  the  processor  structure, 
with  regard  to  expanding  its  avionics  hardware  applicability. 

a.  Basic  Navigation  Equations 

As  discussed  above,  four  basic  navigation  entities  --  vehicle  3-d  posi¬ 
tion,  vehicle  3-d  velocity,  vehicle  angular  orientation,  and  vehicle  angular 
rate  --  were  identified  early  in  the  program  as  comprising  the  set  of  funda¬ 
mental  outputs  which  should  be  generated  in  the  basic  navigation  implemented 
by  the  processor. 

Two  fundamental  and  closely  related  questions  immediately  arise  in  this 
connection.  First,  what  coordinates  should  be  selected  to  represent  each  of 
these  entities,  and  second,  to  what  reference  frames  should  these  coordinates 
be  referenced? 

Addressing  the  latter  question  first,  there  are  in  all  seven  widely  used 
and  convenient  reference  frames  which  are  pertinent  to  the  discussion  here. 
These  are  the  inertial  (I),  earth  fixed  (E  or  EF),  locally  level  (L),  air  (A), 
platform  (P),  and  computational  (C)  frames.  These  frames  are  defined  in  de¬ 
tail  in  the  List  of  Symbols  and  Abbreviations.  The  first  five  of  these 
frames  (I,  E,  EF,  L,  and  A)  comprise  the  set  of  candidate  frames  from  which 
the  mechanized  C  and  P  frame  orientations  were  selected. 

The  fact  that  position  and  velocity  with  respect  to  the  earth  are  two  of 
the  fundamental  output  requirements  for  the  basic  navigation  processor  allowed 
iimnediate  elimination  of  the  A  and  I  frames  in  favor  of  the  closely  earth- 
related  E,  EF,  and  L  frames.  Inmediate  elimination  of  the  A  frame  (for  rota- 
tionally  isolated  platforms)  as  a  P  frame  candidate  was  also  natural,  since 
this  would  be  tantamount  to  unnecessarily  mechanizing  a  strapdown  platform. 

Table  II  was  constructed  to  aid  in  completing  the  C  and  P  frame  selec¬ 
tions.*  The  table  summarizes  the  broad  computational  requirements  imposed  by 
any  combination  of  C  and  P  frame  selections  from  among  the  remaining  candidate 
frames.  Overall  computational  requirements  are  broken  down  into  J3  different 


*Table  II  is  a  comparison  based  on  inertial  navigation  only  (see  Appendix  III). 
However,  since  this  mode  imposes  a  greater  computational  load  than  the  others 
(e.g.,  ADR)  required  of  the  processor,  it  was  felt  this  was  appropriate  for  a 
limited  tradeoff  investigation. 
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TABLE  II.  BASIC  INERTIAL  NAVIGATION  COMPUTATIONAL  REQUI1 
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basic  computational  operations.  Each  of  these  is  expressed  in  terms  of  a 
generalized,  all-frame,  vector /matrix  equation  (see  Appendices  II  and  III), 
and  the  simplifications  --  if  any  --  of  this  operation  which  result  from  any 
particular  C/P  selection  are  indicated. 

Using  the  table,  it  is  evident  that  the  choice  C  =  L  would  be  inadvis¬ 
able  relative  to  the  selected  C  =  E/EF,  since  (a)  C  =  L  does  not  provide  E/EF 
frame-referenced  position  and  velocity  as  natural  outputs,  while  C  =  E/EF 
does;  (b)  the  L  frame  does  rotate  (as  the  vehicle  moves  over  the  surface  of 
the  earth)  with  respect  to  the  earth,  while  the  E/EF  frame  does  not;  this  re¬ 
quires  the  dynamic  updating  of  the  C  versus  E  frame  transformation  in  the 
former  case,  but  obviates  it  in  the  latter;  and,  (c)  most  tactical,  target- 
referenced  frames  are  basically  E/EF,  rather  than  L  frames.  The  choice 
C  =  E/EF  has  therefore  been  made  for  these  reasons. 

On  the  other  hand,  the  choice  P  =  L,  rather  than  P  =  E/EF,  seems  a  natural 
one  for  (rotat ionally  isolated)  platform  attitude  stabilization.  This  is 
so  because  (a)  it  eliminates  tumbling  of  the  gravity  vector  with  respect  to 
the  inertial  instruments;  such  tumbling  excites  g-sensitive  inertial  instru¬ 
ment  errors,  which  can  lead  to  the  need  for  costlv  modeling  of  such  errors  in 
the  Kalman  filter;  and  (b)  it  provides  aircraft  roll,  pitch  and  yaw  as  natural 
gimbal  angle  outputs,  without  the  need  for  further  coordinate  conversion. 
However,  on  closer  scrutiny,  there  are  many  situations  (e.g.,  during  align¬ 
ment)  in  which  the  platform,  even  though  nominally  locally  level  stabilized, 
will  in  fact  be  significantly  misaligned  with  respect  to  the  true  L  frame. 
Recognition  of  this  fact  --  i.e.,  by  allowing  for  separate  P  and  L  frames  in 
the  processor  mechanization  --  therefore  provides  a  desirable  flexibility  (and 
performance  improvement)  of  the  processor  with  regard  to  the  processing  of 
platform  instrument  inputs  and  control  outputs.  In  addition,  the  facts  that 

(a)  the  L  frame  is  a  natural  one  in  which  to  represent  wind  estimates,  and 

(b)  P  and  L  frame  separation  is  mandatory  in  the  case  of  a  strapdown  platform 
anyway,  add  force  to  the  argument  in  favor  of  such  a  separation.* 

Choosing  C  and  P  to  be  noncoincident  does,  of  course,  lead  to  the  compu¬ 
tational  need  for  maintaining  a  dynamic  transformation  between  these  two 
frames.  Although  this  would  be  unnecessary  if  the  two  frames  had  been  chosen 
to  coincide  (i.e.,  by  choosing  both  C  and  P  as  L  frames,  or  both  as  E/EF 
frames),  it  is  nevertheless  felt  that  the  advantages  of  frame  separation,  as 
discussed  above,  outweigh  this  and  other  disadvantages. 

The  selection  C  *  E/EF  also  benefits  from  the  fact  that  the  E  and  EF 
frames  are  closely  related;  i.e.,  both  are  fixed  to  the  earth  and  therefore 
are  not  rotating  with  respect  to  one  another.  This  has  been  discovered  to 
result  in  a  very  high  degree  of  similarity  between  the  basic  inertial  naviga¬ 
tion  and  navigation  error  equations  formulated  for  each  of  the  two  frames. 


*When  such  a  separation  is  mechanized,  an  additional  interframe  transforma¬ 
tion  to  those  shown  on  Table  II  is  of  course  required.  However,  since  this 
additive  requirement  is  common  to  all  P  frame  choices  shown,  it  does  not 
alter  the  tradeoff  comparisons. 
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As  a  matter  of  fact,  it  has  allowed  the  formulation  of  essentially  a  single 
set  of  such  equations  which  is  equally  applicable  to  E  or  EF  frame-referenced 
computations,  if  augmented  by  some  simple,  interframe  switching  computations. 
This  is  felt  to  be  a  significant  advantage  with  regard  to  simplification  of 
the  overall  processor  design  in  multiphase  missions. 

Turning  to  the  remaining  question  of  coordinate  type  (e.g.,  polar, 
spherical,  Cartesian,  etc.)  the  choice  of  Cartesian  coordinates  is  a  natural 
one,  since  (a)  such  coordinates  inherently  lend  themselves  to  Cartesian, 
orthogonal  vector  representation,  and  are  thus  compatible  with  the  extensive 
and  advantageous  employment  of  vector-matrix  algorithm  formulations  throughout 
the  processor  (see  paragraph  b,  below),  and  (b)  use  of  these  coordinates  leads 
naturally  to  the  selection  of  corresponding  Cartesian  coordinates  as  error 
state  variables  in  the  processor  Kalman  filter  (this  produces  truly  linear 
measurement -state  relationships,  which  uniquely  enable  the  accurate  generation 
of  large  Kalman  filter  error  estimates  and  resultant  processor  variable 
corrections  --  which  would  be  impossible  if  the  often-used  quasilinear  angular 
error  variables  were  employed  instead). 

b.  Vector /Matrix  Algorithms 

It  is  evident  from  Table  II  that  the  use  of  vector /matrix  notation  great¬ 
ly  simplifies  both  the  overall  representation  of  the  equations  shown  and  the 
identification  of  common  subroutine  candidates  (e.g.,  3x3  matrix  multiplica¬ 
tion)  among  those  equations  as  well.  Both  of  these  characteristics  are 
patently  important  advantages  in  the  organization  of  an  efficient,  compact, 
and  flexible  computer  program. 

Although  Table  II  is  limited  only  to  inertial  navigation,  almost  all 
other  processor  functional  areas  can  be  similarly  formulated.  For  example, 
in  the  area  of  radio  navigation  data  processing,  ihe  fundamental,  geometric 
pseudoranging  process  rwhich  comprises  the  whole  range  of  phase/phase  differ¬ 
ence  techniques  including  Loran,  Omega,  NAVSAT,  TACAN  (EME),  etc.,]  in¬ 
trinsically  always  involves  --  and  therefore  can  be  formulated  in  terms  of  -- 
the  vector  dot  product,  cross  product  and  absolute  value  operations.  In  the 
area  of  airspeed  dead  reckoning  (ADR),  wind  and  airspeed,  and  their  subsequent 
processing  into  position  and  velocity  vectors,  can  also  naturally  be  expressed 
as  vectors  and  vector -matrix  operations,  respectively.  Most  other,  non- 
Kalman  operations  can  also  be  formulated  equally  easily  and  completely  in 
vector/matrix  terms. 

Finally,  in  the  area  of  Kalman  filtering  operations,  which  can  comprise 
a  very  large  portion  of  the  overall  processor  computational  load  in  any  spe¬ 
cific  application,  use  of  vector/matrix  operations  is  perhaps  the  most 
natural  and  advantageous  of  all.  This  is  partly  because  the  equations  were 
originally  naturally  formulated  in  vector-matrix  terms  by  Kalman  himself,  and 
partly  because  further,  this  formulation  leads  naturally  to  a  highly  useful 
decomposition  of  the  o\erall  filter  equations  into  a  set  of  mainly  equipment- 
dedicated  equations,  based  on  the  use  of  standard  matrix-partitioning  tech¬ 
niques  on  the  unpartitioned  equations. 
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c .  Functional  Modularity/Commonalit’ 


Simple  logic  dictates  that  if  processor  design  is  to  be  kept  compact  and 
easily  manageable,  and  at  the  same  time  capable  of  accommodating  a  wide 
variety  of  mission  and  navigation  hardware  requirements,  the  ancient  but  pow¬ 
erful  concepts  of  functional  modularity  and  functional  commonality  must  be 
exploited.  To  this  end,  a  careful  consideration  of  how  best  to  decompose  the 
overall  basic  navigation  computations  into  a  set  of  functionally  distinct 
modules  was  undertaken  early  in  the  Phase  1  effort. 

Two  basic  ground  rules  were  quickly  identified.  First,  the  primary 
modular  division  ought  to  be  largely  navigation  hardware  oriented;  e.g.,  all 
computations  associated  with  IMU  data  use  and  control  should  be  grouped  into 
a  single,  functional,  IMU  module  (or  submodule).  This  would  (a)  simplify  the 
complete  bypassing  of  such  computations  as  a  group  in  cases  of  IMU  hardware 
malfunction  in  an  overall  hardware  configuration  containing  an  IMU,  and 
(b)  allow  for  the  easy  omission  of  an  IMU-related  computation  in  configuring 
software  for  systems  not  involving  an  IMU,  or  for  later  augmenting  the  soft¬ 
ware  if  an  IMU  were  added. 

Second,  it  was  also  apparent  that  within  each  module  of  such  an  overall 
modular  structure,  two  classes  of  functional  operations  could  be  usefully 
distinguished:  those  which  were  independent  of  differences  in,  and  therefore 
conmon  to,  the  various  types  of  hardware  associated  with  that  module,  and 
those  which  depended  on  the  peculiarities  of  each  such  hardware  type.  For 
example,  assuming  a  single  computational  reference  frame,  there  are  several 
well-known  mathematical  techniques  for  updating  the  required  IMU  platform/ 
computational  axes  transformation,  each  one  of  which  could  be  used  for  either 
the  strapdown  or  the  rotationally  free  types  of  IMU.  On  the  other  hand,  the 
algorithms  for  airborne  IMU  error  compensation  for  ground-calibrated  IMU 
error  sources  are  highly  dependent  in  form  and  extent  on  the  nature  and  ar¬ 
rangement  of  the  IMU  gyros  and  accelerometers. 

Use  of  these  two  principal  ground  rules  led  to  the  overall  modular  pro¬ 
cessor  framework  described  in  general  by  Figure  3,  and  discussed  in  para¬ 
graph  f. 

In  the  search  for  algorithm  coninonality ,  it  quickly  became  evident  that 
the  use  of  vector -matrix  algorithm  formulations  was  the  key.  When  expressed 
this  way  --  instead  of  in  terms  of  the  customary  scalar  equations  --  super¬ 
ficially  disparate  types  of  inertial  navigation  schemes  (e.g.,  north  slaved, 
free  azimuth,  strapdown,  unipole,  etc.)  look  in  large  part  suspiciously 
similar.  This  is  no  accident,  but  is  due  to  the  simple  fact  that  each  of 
these  is  essentially  a  mechanization  of  the  same  physical  problem;  namely 
(using  inertial  navigation  as  an  example),  the  continuous  determination  of 
position  and  velocity  by  means  of  a  device  (the  IMU)  which  measures  accelera¬ 
tion  (except  for  gravity),  and  attitude  rate.  In  addition,  Kalman  filtering 
equations  (see  paragraph  d.)  are  by  far  most  easily  and  naturally  expressed 
in  vector -matrix  form.  Also,  the  extensive,  well-known  partitioning  techniques 
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associated  with  vector -matrix  formulations  lend  themselves  naturally  to  the 
functional  modularizing  (functional  partitioning)  process  outlined  above. 

Finally,  it  is  important  to  emphasize  here  that  the  overall  functional 
modularity/commonality  structure  adopted  for  the  processor  under  considera¬ 
tion  here  is  principally  a  means  to  achieve  one  of  its  central  and  most  im¬ 
portant  characteristics:  generality.  While  the  flexibility  inherent  in  this 
structure  guarantees  that  it  will  provide  easy  adaptability  to  the  mission 
requirements  and  hardware  associated  with  any  single  system,  and  minimize  re¬ 
dundant  software  development  for  the  class  of  systems  to  which  it  applies,  it 
cannot  result  in  software  quite  as  efficient  for  any  single  system  as  that 
developed  specifically  for  that  system.  Averaged  over  many  systems,  however, 
generalized  software  of  this  type  is  unquestionably  far  more  cost-effective 
than  the  much  larger  body  consisting  of  the  sum  of  all  the  specialized  soft¬ 
ware  separately  developed  for  each  such  system. 

d.  Kalman  Filtering 

Use  of  a  Kalman  filter  as  an  integral  and  central  processor  feature  was 
decided  upon  because:  (a)  its  natural  formulation  is  a  linear,  vector-matrix 
one,  so  that  it  lends  itself  to  modularization  and  algorithm  commonality  with 
the  rest  of  the.  processor  computations;  (b)  in  the  area  of  pseudoranging  in 
particular,  it  inherently  incorporates  the  geometric,  coordinate-conversion 
function;  (c)  it  offers  the  greatest  possible  theoretical  accuracy  potential 
in  use  of  available  navigation  data,  and  (d)  it  provides  a  natural  basis  for 
statistically  optimal,  emitter  data  reasonableness  and  selection  algorithms. 

Taking  these  in  turn,  one  of  the  central  conceptual  and  computational 
entities  in  the  structure  of  any  Kalman  filter  is  the  state  estimate  vector, 
or  more  exactly  in  the  case  of  vehicle-borne  navigation  systems,  the  error 
state  estimate  vector.  This  is  simply  the  set  of  estimates  of  the  set  of 
scalars  which  are  used  to  model  the  errors  in  the  overall  navigation  system 
information  flow.  The  entire  vector -matr ix  structure  of  overall  filter  compu 
tations  is  based  in  turn  on  the  order  and  meaning  of  these  error  variables. 
Once  the  concept  of  hardware-oriented  modularization  of  the  non-Kalman  navi¬ 
gation  computations  described  above  was  formulated,  it  became  obvious  that 
this  concept  could  be  naturally  and  easily  extended  to  correspondingly  modu¬ 
larize  the  Kalman  filtering  computations  as  well.  This  consisted  simply  in 
ordering  and  grouping  the  error  variables  in  the  overall  state  vector  in  such 
a  way  as  to  form  a  set  of  separate  blocks  of  variables,  each  block  consisting 
solely  of  the  set  of  modeled  errors  associated  with  the  computations  and  hard 
ware  of  just  one  of  the  non-Kalman  functional  modules.  This  idea  was  care¬ 
fully  developed,  and  has  been  incorporated  into  the  processor  to  allow  for 
the  easy,  hardware -dedicated  structuring  of  the  Kalman  as  well  as  the  non- 
Kalman  portions  of  the  overall  processor  software. 
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As  mentioned  above,  the  Kalman  filter  basically  generates  continuous 
estimates  not  of  the  overall  navigation  variables  themselves,  but  only  of 
the  errors  in  these  variables.  These  error  estimates  are  then  used  to  per¬ 
iodically  correct  the  values  of  the  overall  navigation  variables.  Corres¬ 
pondingly,  these  error  estimates  are  generated  by  use  of  (noisy)  measure¬ 
ments  of  the  differences  between  two  synchronous  estimates  of  some  geometric 
quantity,  so  that,  since  the  true  value  of  this  quantity  cancels  out  in  the 
differencing,  the  measurement  really  consists  of  the  difference  of  the  errors 
in  the  two  estimates  of  the  quantity.  The  measurement  difference  is  there¬ 
fore  directly  related  to  certain  of  the  primary  navigation  error  variables 
(i.e.,  state  variables).  If  the  errors  are  small,  then  this  in  general  non¬ 
linear  relation*  can  be  approximated  by  a  linear  one  (the  so-called  Kalman 
measurement  or  observation  matrix),  which  embeds  the  coordinate  conversion 
function.  For  example,  if  the  geometric  quantity  being  estimated  is  range 
to  a  simple  emitter,  the  (say)  two-way  signal  phase  shift  provides  one  range 
estimate,  while  use  of  Pythagoras'  theorem  on  user  and  emitter  position 
coordinates  provides  another.  In  differencing,  the  true  range  cancels  out, 
so  that  the  measurement  difference  really  involves  only  the  difference  of 
the  user  and  emitcer  location  errors  along  the  line  of  sight,  plus  of  course 
the  inevitable  ranging  signal  phase,  propagation  and  receiver  noise  errors. 
Assuming  that  the  emitter  location  error  is  negligible,  the  filter  will  in 
fact  estimate  the  component  of  user  position  error  along  the  user-emitter 
line  of  sight,  using  the  user-emitter  geometric  information  embedded  in  the 
measurement  matrix,  and  will  then  correct  u.»er  position  accordingly.  Thus 
not  only  does  the  filter  embed  the  necessary  geometric  coordinate-conversion, 
but  it  can  make  maximum  use  of  radio  navigation  information  data  (e.g.,  lange) 
from  whatever  number  of  emitters  whose  signals  are  currently  available,  even 
if  this  is  less  than  (or  more  than)  the  number  required  to  determine,  say, 

3-d  user  position. 

Ir>  addition  to  these  coordinate  conversion  capabilities,  the  Kalman 
filter  is  also  a  minimum-variance,  statistical  filter.  That  is,  given  a 
measurement  difference,  its  consequent  estimates  of  error  state  variables 
are  based  on  (in  addition  to  the  linear  geometric  relations  discussed  above), 
the  relative  uncertainty  it  associates  with  the  variables  concerned.  Specifi¬ 
cally,  these  uncertainties  are  carried  as  numerical  variances,  one  associated 
with  each  state  variable.  For  example,  if  in  the  ranging  example  above,  the 
variance  associated  with  the  user  position  error  was  much  larger  than  that 
associated  with  the  emitter,  then  the  filter  would  assign  the  entire  measure¬ 
ment  difference  to  user  position  error,  and  reset  it  alone.  On  the  other 
hand,  if  the  converse  were  true,  only  the  emitter  position  error  would  be 
estimated  and  only  the  emitter  position  error  reset  accordingly.  For  inter¬ 
mediate  cases,  both  would  be  partially  reset.  This  kind  of  filter  is  there¬ 
fore  optimum  in  the  sense  that,  given  a  large  number  of  noisy  measurements, 


*If  the  relationship  is  actually  linear,  then  neither  the  errors  nor  the 
measurement-differences  need  be  small. 
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and  accurate  error  variable  statistics,  it  will  theoretically  reset  processor 
navigation  variables  with  less  residual  error  than  any  other  type  of  filter. 

Finally,  the  error  estimate  variances  carried  by  the  filter  to  accom¬ 
plish  the  minimum-variance  weighting  described  above,  also  provided  a 
natural  and  convenient  basis  for  the  construction  of  statistical,  emitter 
data  reasonableness  and  selection  algorithms,  which  are  embedded  in  the 
current  processor  definition.  These  are  discussed  in  paragraph  f. 

e.  Overall  Navigation  Information  Processing  Organization 

Once  a  set  of  navigation  system  sensor  hardware  has  been  decided  upon, 
a  range  of  options  remains  as  to  the  manner  in  which  the  software  shall  pro¬ 
cess  (i.e.,  conduct  navigation  using)  the  data  available  from  these  sensors. 
At  first  sight,  all  these  options  would  seem  to  fall  into  one  of  two  familiar 
classes;  i.e.,  the  use  of  the  data  from  any  one  given  sensor  either  (a)  to 
directly  drive  DR  (dead  reckoning)  navigation  in  the  intervals  between  suc¬ 
cessive  availability  of  reference  measurement  data,  or  (b)  to  provide  such 
periodic,  reference  measurement  data  itself. 

For  example,  assuming  an  equipment  set  consisting  of  an  IMU  and  a 
NAVSAT  receiver,  a  natural  data  processing  philosophy  would  be  to  use  the 
essentially  continuous  IMU  accelerometer  data  to  continuously  (i.e.,  at  a 
very  high  data  rate)  and  directly  drive  the  velocity  and  position  updates, 
and  to  use  the  (lower  data  rate)  NAVSAT  pseudoranging  data  as  reference 
measurements  to  periodically  correct — via  an  appropriate  navigation  filter 
— DR  position  and  velocity,  as  well  as  (perhaps)  the  errors  in  IMU  measure¬ 
ments  of  acceleration,  and  the  errors  in  NAVSAT  pseudoranging  measurements 
due  to  NAVSAT/receiver  clock  phase  difference  and  signal  propagation  delay 
errors. 

On  the  other  hand,  assuming  the  availability  of  an  adequately  high  re¬ 
ceiver  pseudoranging  data  rate,  then  position  (and  perhaps  velocity  as  well 
if  doppler  shift  data  is  mechanized)  might  be  directly  tracked  by  use  of  the 
NAVSAT  receiver  outputs*,  and  the  (lower  data  rate)  IMU  data  treated  as 
navigation  reference  data  for  processing  through  the  navigation  filter. 

This  latter  approech  (NAVSAT  dead  reckoning)  is  less  desirable  than  the 
former  (IMU  dead  reckoning),  however,  because  the  former  is  essentially  a 
differential  (predictive),  and  the  latter  an  integral  (historical)  process. 
That  is,  when  the  NAVSAT  DR  approach  is  used,  vehicle  acceleration  can  only 
be  inferred  by  noisy  differentiation  of  the  DR  position  and/or  velocity  esti¬ 
mate,  while  in  the  IMU  DR  (IDR)  approach,  it  is  measured  directly  by  the  IMU 
accelerometers,  and  velocity  and  position  are  inferred  by  noise-smoothing 
integrations. 


♦Simultaneous  three-channel  tracking  of  at  least  three  satellite  emitters 
would  of  course  be  necessarv  to  maintain  3-d  position  and  velocity. 
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When  no  1MU  is  available  [or  no  AHRU/TAS  backup  equipment  combination 
to  provide  (integral)  airspeed  dead  reckoning  (ADR)  instead]],  so  that  posi¬ 
tion-level  DR  via  NAVSAT  or  other  pseudoranging-type  equipment  is  necessary, 
then  this  technique  can  be  improved  upon— i.e.,  made  more  integro-historical 
—by  creating  an  artificial  computational  model  of  vehicle  dynamics  (accel¬ 
eration,  velocity,  and  position)  using  whatever  is  known  (either  s  priori  or 
via  other  onboard  equipment)  about  the  dynamical  characteristics  of  the 
carrier  vehicle,  to  implement  this  model.  For  example,  in  a  coordinated 
turn,  the  vehicle  acceleration  vector  is  always  normal  to  its  velocity 
vector,  and  the  occurrence  of  such  a  turn  is  signalled  by  the  behavior  of 
the  vehicle  control  surface  settings.  Such  information  could  be  used  to 
condition  an  appropriate  filter  (e.g.,  a  Kalman  filter)  to  "expect"  (and 
therefore  to  better  estimate)  a  large  cross-track  acceleration  when,  say, 
aileron  setting  is  suddenly  changed.  This  general  technique— creating  a 
vehicle  dynamics  model  to  accomplish  continuous  dead  reckoning  navigation  in 
the  intervals  between  successive  use  of  position  measurement  data  (via  say 
pseudoranging  data)— has  for  convenience  of  reference  been  termed  pseudo 
dead  reckoning  (PDR)  and  has  been  tentatively  adopted  and  embedded  in  the 
overall  processor  design,  for  use  whenever  no  source  of  continuous  acceler¬ 
ation-level  or  velocity- level  data  for  DR  navigation  is  available. 

In  particular,  this  mode  can  be  used  to  advantage  in  start-up  situa¬ 
tions,  to  maintain  continuous  radio- autonomous  navigation  while  coarse  IMU 
or  AHRU  (if  available)  alignment  relative  to  the  computational  (C)  frame  is 
being  carried  out. 

The  altitude  channel  ia  also  given  a  similar  treatment  to  provide  over¬ 
all  processor  uniformity  of  operation  in  the  face  of  loss  of  barometric 
altitude  information.  As  long  as  such  data  is  available,  it  is  trested  as 
reference  measurement  data  (regardless  of  whether  the  processor  DR  mode  is 
IDR,  ADR,  or  PDR).  When  such  data  is  lost,  however,  the  last  value  of  alti¬ 
tude  is  retained  and  decayed  slowly  toward  nominal  vehicle  cruise  altitude. 
This  pseudo  altitude  is,  however,  still  trested  as  a  reference  altitude 
measurement  by  the  Kalman  filter  (but  given  a  growing  statistical  uncer¬ 
tainty)  . 

To  summarize,  fo”  the  complete  navigation  equipment  complement— IMU, 
AHRU,  CADS,  and  tranaceiver(a)— comprising  current  processor  processing 
capabilities,  the  basic  processor  navigation  mode  rules  are  simply: 

•  If  IMU  is  available,  then  IDR 

•  If  IMU  is  not  available,  but  AHRU/CADS(TAS)  is,  then  ADR 

•  If  neither  IMU  nor  AHRU/CADS(TAS)  is  available,  but  radio  pseudoranging 
equipment  is,  then  PDR 

•  Radio  pseudoranging  and  barometric/pseudoaltitude  data  (or  visual  posi¬ 
tion  fix  data)  ia  always  used  only  as  reference  navigation  measurement 
data  through  the  Kalman  filter,  and  never  as  a  direct  DR  data  source. 
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•  "Available"  in  the  above  means: 

•  I  MU  or  AHRU:  Coarse  plat form-to-computer  alignment  is  complete  and 
valid  navigation  data  is  being  generated. 

•  CADS(TAS  or  barometric  altitude):  Valid  navigation  data  is  being 
generated. 

•  Pseudoranging  equipment:  Signal  acquisition  is  complete  and  valid 
navigation  data  is  being  generated. 

f .  Processor  Modular  Organization 

With  the  preceding  discussion  as  a  background,  this  subsection  presents 
an  overall  summary  of  the  modular  navigation  processor,  which  is  presented 
in  MLI  specification- level  detail  in  Section  III. 

The  overall  processor  has  been  organized  into  four  conceptually  dis¬ 
tinct  modular  groups— the  dead  reckoning  navigation  (D  or  DR)  modules,  the 
reference  navigation  measurement  (R)  modules,  the  Kalman  filter  (K  or  KF) 
modules,  and  tho  processor  mode/configuration  initialization  and  switching 
modules.  These  four  modular  groups  are  discussed  in  order  in  the  following 
paragraphs.  As  a  reference  in  these  discussions,  Figure  3  summarizes  infor¬ 
mation  flow  between  these  modular  groups  within  the  processor,  and  across  the 
processor/navigation  sensor  interface  as  well. 

(1)  DR  Nav  Modules 

This  group  includes  the  Vehicle  State  Module  (VSTM) ,  the  Platform 
Module  (PLAM) ,  and  the  Wind/Airspeed  Module  (WASM) .  Together,  these  modules 
comprise  the  processing  necessary  to  conduct  continuous,  basic  DR  navigation 
in  the  IDR,  ADR,  or  PDR  modes.  In  all  DR  modes,  this  means  the  continuous 
generation  of  the  C  frame  referenc'd  position  and  velocity  vectors. 

In  the  IDR  or  ADR  modes,  where  a  platform  is  available  to  measure  airframe 
attitude  (and  perhaps  attitude  rate),  the  orthogonal  airframe-to- (earth- 
fixed)  computational  frame,  and  the  corresponding  C  frame-referenced  air¬ 
frame  angular  rate  vector  are  additionally  generated  as  basic  navigation 
outputs  (and  a  wind  vector  as  well).  Table  III  summa-ires  the  use  and 
function  of  each  D  module  by  DR  mode. 

From  Table  III  it  is  evident  that  a  considerable  degree  of  intermodal 
functional  conmonality  exists.  This  has  been  emphasized  in  the  MLI  specifi¬ 
cation  for  each  module  by  grouping  (and  logically  addressing)  the  overall 
functions  required  of  each  module  into  those  required  in  common  for  all 
three  DR  modes,  those  required  in  common  only  for  modes  i,i  pairs,  and  those 
particular  to  each  mode.  This  grouping,  together  with  the  simple  DR  mode- 
to-DR  navigation  hardware  sensor  correspondence  rules  (see  Section  III, 
paragraph  3.e),  has  resulted  in  a  very  significant  simplification  of  the 
processor  DR  mode  switching  logic,  .and  in  a  very  simple  and  direct  DR  nav 
hardvare-to-softvare  modular  correspondence.  These  techniques  have  also 
been  used  in  both  the  R  module  and  K  module  groups,  discussed  in  paragraphs 
(2)  and  (3). 
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TABLE  III.  DR  NAV  MODULES:  SUMMARY  OF  OPERATIONS  AND  USE  BY  MODE 
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From  Table  III  It  is  also  evident  that  a  high  degree  of  interdependence 
exists  between  the  separate  DR  modules.  This,  a3  will  be  seen,  is  in  direct 
contrast  to  the  R  modules,  which  are  essentially  mutually  independent. 

(2)  Reference  Navigation  Measurement  Modules 

This  group  includes  the  reference  altitude  module  (ALTM) ,  the  position 
fix  module  (POSM) ,  and  the  transceiver  data  processing  module  (TDPM) .  In 
general,  each  of  these  hardware-specific  modules  executes  two  types  of  oper¬ 
ation.  First,  it  accomplishes  the  processing  of  input  sensor  data  from  its 
particular  sensor  or  input  source  (and  in  the  case  of  the  TDPM,  provides 
rate  aiding  control  feedback  as  well)  into  an  estimate  of  some  fundamental 
navigation  quantity  (e.g.,  barometric  altitude,  radio  pseudorange) .  Second, 
it  synchronously  computes  a  second  estimate  of  the  same  navigation  quantity 
based  on  the  basic  DR  navigation  module  outputs  and  forms  the  synchronous 
difference.  These  synchronous  differences  form  the  basic  input  measurements 
used  by  the  Kalman  filter  to  subsequently  estimate  and  correct  D  and  R 
module-associated  navigation  quantities.  Since  these  R  modules  are  mainly 
independent  of  one  another,  they  are  discussed  in  turn  in  the  following 
paragraphs. 


(a)  Reference  Altitude  Module  (ALTM) 

The  functions  executed  by  this  module  depend  on  whether  the  vehicle  is 
on  the  ground  or  airborne,  and  whether  or  not  barometric  altitude  is  avail¬ 
able,  as  summarized  in  Table  IV.  Note  that  synchronous  differencing  of  the 
DR  and  reference  altitude  measurements  is  specified  in  order  to  remo /e 
vehicle  dynamics.  This  technique  is  uniformly  specified  for  all  R  modules. 

(b)  Position  Fix  Module  (POSM) 

This  module  simply  converts  panel-inserted  visual  position  fix  data 
from  input  coordinates  (e.g.,  latitude/longitude/altitude)  into  an  internal 
C  frame-referenced  position  vector,  and  synchronously  differences  this 
vector  with  the  corresponding  DR-generated  position  vector. 

(c)  Transceiver  Data  Processing  Modules  (TDPMs) 

The  design  technique  utilized  in  establishing  the  overall  TDFM  module 
group  was  a  detailed  examination  of  the  functional  tusks  required  for  the 
various  emitter  types.  Three  basic  emitter/user  transceiver  configurations 
were  identified  by  this  effort:  the  Ground,  the  Airborne,  and  the  Satellite 
Emitter  configurations.  A  set  of  overall,  al 1-conf iguration  functional  tasks 
was  established  and  organized  into  a  corresponding  set  of  TDPM  moduler. 

Within  each  module  the  attendant  functional  tasks  were  then  further  organized 
in  terms  of  their  use  by  configuration  type. 
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SIAMARY  OF  OPERATIONS  AND  USE  BY  REFERENCE  ALTITUDE  MODE 


The  modules  established  by  this  functional  organization  were: 

•  Emitter  Word  Processing  (TEWM) 

•  Propagation  Correction  (TPCM) 

•  Range  and  Range  Rate  Generation  (TRRM) 

•  Kalman  Measurement  Observables  (TMOM) 

•  Antenna  Lever  Arm  Compensation  (TALM) 

•  Kalman  Measurement  Matrix  (TMMM) 

•  Data  Statistics  Generation  (TDSM) 

•  Acquisition  and  Aiding  (TAAM) 

An  important  design  feature  which  has  been  incorporated  in  the  module 
definition  is  the  combination  of  both  range  and  range  rate  calculations 
within  the  same  modules,  since  these  entail  almost  identical  mathematical 
operations  and  from  a  programming  structure  standpoint  could  therefore  share 
the  same  operational  subroutines  with  only  a  variation  of  input  and  output 
parameter  definition.  The  design  also  embeds  a  single  propagation  link  error 
state  definition  which  represents  the  amalgamated  effect  of  numerous  algorith¬ 
mic  uncertainties  in  determining  the  exact  link  error.  The  inclusion  of  an 
expanded  error  state  vector  of  increased  dimension  was  not  considered  as  being 
warranted  due  to  the  basic  unobservability  of  the  various  link  error  contributors. 

It  should  be  noted  that  the  radio  navigation  treatment  in  this  document 
is  almost  exclusively  LOS-oriented,  since  attention  in  Phase  II  was  concen¬ 
trated  on  this  type,  rather  than  on  the  earth  mode  type,  of  radio  signal. 

However,  a  brief  joint  Northrop/Magnavox  review  of  the  LOS  radio  navigation 
module  specifications  presented  in  subsection  III.3.C  of  this  report  revealed 
that  five  of  those  (the  TEWM,  TALM,  TRRM,  TMOM,  and  TMMM  modules)  would  re¬ 
quire  only  minor  revision  to  additionally  accommodate  earth  mode  emitter 
processing,  two  others  (TDSM  and  TAAM)  would  need  careful  review  to  ascertain 
how  much  modification  would  be  necessary,  and  only  one  (TPCM)  would  clearly 
require  major  extension. 

(3)  Kalman  Filter  Modules 

There  are  eight  Kalman  Filter  (K)  modules,  falling  into  four  distinct 
conceptual  groups  as  follows: 

•  Prediction  Modules:  Estimate/covariance  Matrix  Time  Update  Module  (KTUM), 
and  the  Time  Update  Matrix  Generation  Module  (KTMM) 

•  Measurement  Preprocessing  Modules:  Measurement  Matrix  Generation  Module 
(KMMM) ,  anc.  the  Measurement  Reasonableness,  Combination,  and  Optimal 
Selection  Modules  (KMRM,  KMCM,  KMOM) 

•  Filtering  Module:  Estimate/Covariance  Matrix  Filtering  Update  Module 
(KFIM) 

•  Control  Module:  Estimate/Processor  Control  Module  (KCOM). 
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The  functions  of  these  modules  are  best  understood  against  the  back¬ 
ground  of  the  fact  that,  because  of  the  extent  of  the  computations  required 
to  fully  execute  one  cycle  of  all  Kalman  operations  even  when  only  a  small 
navigation  system  error  model  is  incorporated  in  the  filter  design,  the 
Kalman  execution  cycle  is  of  necessity  considerably  longer  than  either  the 
DR  module  execution  cycles  or  the  even  slower  R  module  cycles.  Typical 
values,  for  example,  might  be  a  0.1-second  DR  cycle,  a  1.0-second  R  cycle, 
and  a  10-second  KF  cycle. 

In  order  to  accurately  track  significant  system  time-variable  error 
dynamics  (by  computing  their  effect  after  the  fact)  the  error  estimate  pro¬ 
duced  by  the  filter  is  purposely  made  to  lag  essentially  one  KF  cycle  behind 
the  real-time  error  behaviour.  The  control  fed  back  to  other  processor 
modules  by  the  filter  must  therefore  be  compenaated  for  this  lag  to  avoid 
the  destabilizing  effect  of  delay  in  the  stationary  portion  of  system  error 
dynamics.  For  these  reasons,  the  various  K  modules  operate  asynchronously, 
some  conducting  essentially  last-cycle-related,  and  some  current-cycle- 
related,  operations. 

With  this  as  background,  the  roles  of  each  of  the  modules  within  the 
above  groups  during  a  full-operation  Kalman  cycle  are  as  follows: 

•  Prediction  Modules: 

KTUM:  Time  updates  KF  error  estimate  and  associated  covariance  matrix 
across  last  KF  cycle,  using  time  update  matrices  generated  by 
KTMM  in  last  KF  cycle. 

KTMM:  Generates  current-cycle  time  update  matrices  for  use  by  KTUM  in 
next  KF  cycle. 


Measurement  Preprocessing  Modules : 


KMMM:  Generates  current-cycle-measurement/KF  cycle  endpoint-synchroniz¬ 
ing  measurement  matrices  for  use  by  KMRM,  KMCM,  and  KMOM  in  next 
KF  cycle. 


KMRM:  Generates  current-cycle  statistical  reasonableness  tests  on  candi¬ 
date  last-cycle  measurements  (and  their  associated  matrices). 


KMCM:  Combines  (linearly  or  nonlinearly)  last-cycle  measurements  (and 
their  associated  matrices)  which  have  passed  KMRM  reasonableness 
tests. 


KMOM:  Optimally  orders  current-cycle  KMCM  output  (last-cycle)  measure 
ments  (and  associated  matrices)  for  use  by  KFIM. 


•  Filtering  Module : 


KFIM:  Updates  KF  error  estimate  and  associated  covariance  matrix  using 
KMOM  outputs  (last-cycle  measurements  and  associated  matrices). 
Resulting  estimate  and  covariance  matrix  relate  to  start  of 
current  KF  cycle. 
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•  Control  Module: 


KCOM:  Predicts  KFIM  estimate  to  end  of  current  cycle  and  computes  appro¬ 
priate  corrections  to  DR  and  R  module  navigation  variables,  and 
to  KF  estimator.  Applies  the  former  to  DR  and  R  modules  at  end  of 
current  cycle,  and  applies  estimator  correction  generated  by  last- 
cycle  KCOM  operation  to  this-cycle  KFIM  estimate  (start-of-cycle 
estimate) . 

Each  of  the  functions  executed  by  each  of  these  modules  has  been  parti¬ 
tioned*  That  is,  instead  of  algorithms  formulated  to  process  the  full  error 
state  estimate  vector  (and  all  its  associated  vectors  and  matrices)  essen¬ 
tially  as  a  single  entity,  the  algorithms  have  instead  been  uniformly 
formulated  to  process  a  set  of  much  smaller  function-  and  hardware  module- 
oriented  partitions,  which  together  comprise  the  equivalent  of  the  full- 
state  algorithms. 

There  are  several  levels  of  this  partitioning,  as  follows.  At  the 
broadest  level  is  the  partitioning  of  the  overall  state  x  into  a  DR 
navigation-related  substate,  x^,  and  a  reference  navigation-related  substate, 

x^.  In  particular,  x^  includes  all  of  the  elements  in  the  overall  mechanized 

error  state  model  which  model  errors  in  the  DR  navigation  module  variables, 

and  x  includes  all  those  elements  which  model  errors  in  the  R  module 

R 

navigation  variables. 

Each  of  these  principal  substates  is  in  turn  further  partitioned  into 
more  specific  substates.  Specifically,  the  D  substate  is  broken  down  into 
position  and  velocity  error  substates  which  are  common  to  all  DR  navigation 
modes  (and  which  model  VSTM  errors),  plus  a  set  of  mode-specific  substates  for 
each  particular  DR  mode.  For  example,  in  IDR,  these  additional  substates 
would  probably  include  at  least  a  platform-to-computer  misalignment  substate, 
and  --  depending  on  the  model  depth  required  for  the  specific  processor 
application  --  selected  platform  drift  rate  and  acceleration  measurement  error 
substates  (note  that  these  model  PLAM  errors) . 

The  R  substate  is  correspondingly  decomposed  into  a  set  of  R  navigation 
module-specific  substates.  For  example,  the  nth  emitter  net  error  substate, 
which  models  the  errors  associated  with  pseudoranging  on  emitters  of  a 
particular  net,  might  range  from  one  including  a  common  user-emitter  net 
clock  error  substate  plus  an  emitter  ephemeris  error  substate  plus  separate 
propagation  error  substates  for  each  emitter  in  the  net,  to  no  modeling  at 
all  --  depending  on  the  model  depth  required  and/or  feasible. 

Note  that,  although  it  is  partitioned,  the  filter  is  not  artificially 
(and  deleteriously)  decoupled  by  simply  ignoring  the  inter-substate  co- 
variance  matrices,  which  embed  the  vital  inter-substate  correlations  that 
enable  cross-correction  of  errors  by  measurements  which  do  not  directly 
measure  these  errors.  These  matrices  are  retained  and  updated  so  long  as 
both  substates  concerned  are  present. 
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This  bi-fold  modularity  --  via  the  overall,  eight-module  Kalman  function- 
specific  filter  structure,  and  the  uniform,  intra-KF -module  partitioning 
into  D  and  R  module-specific  substate  operations  --  provides  for  an  extremely 
flexible,  but  at  the  same  time  highly  efficient  Kalman  filter  design.  In 
particular,  the  problem  area  of  Kalman  filter  switching  --  between  DR  modes, 
or  of  the  R  configuration  (e.g.,  as  emitter  nets  drop  out  or  are  acquired 
in  the  course  of  a  mission)  --  is  dramatically  simplified  and  systematized. 
Further,  the  reduction  of  conceptually  difficult  Kalman  filtering  to  its 
essential  elements  using  the  above  techniques  (and  at  the  same  time 
emphasizing  its  vector -matrix  character)  will  in  general  result  in  much 
more  efficient  programming,  since  the  programmer  can  --  after  a  suitable 
learning  phase  --  much  more  easily  visualize  filter  interrelationships  and 
commonalities. 


(4)  Initialization/Switching  Modules 

There  are  six  of  these  modules,  falling  into  two  general  classes  as 
follows: 

•  Initialization  Modules;  Navigation  Start  Module  (NSTM)  and  Coarse  Align 
Module  (CALM) 

•  Switching  Modules:  DR  Navigation  Switching  Module  (DSWM) ,  Reference 
Navigation  Measurement  Switching  Module  (RSWM) ,  Kalman  Filter  Switching 
Module  (DSWM) ,  and  C  Frame  Switching  Module  (CSWM) . 

These  are  discussed  in  turn  in  the  following  paragraphs. 


(a)  Initialization  Modules 

These  modules  are  used  to  establish  initial  PDR  navigation  and  to 
initiate  preparation  for  subsequent  ADR  or  IDR  operation. 

In  particular,  the  NSTM  --  which  is  executed  only  once,  just  after  the 
operator  navigation  start  conmand,  and  prior  to  first  execution  of  any  other 
processor  module  --  simply  initializes  the  C  frame  to  the  D  frame,  generates 
initial  null  vector  estimates  of  VSTM  position  and  velocity  and  of  KF 
position  and  velocity  error  substates,  and  assigns  very  large  initial  variances 
to  the  latter.  Assuming  the  availability  of  a  panel-entered  initial  visual 
fix  and/or  continuous  LOS  pseudoranging  data,  the  Kalman  filter  will  subse¬ 
quently  quickly  correct  position  and  velocity  to  navigation-quality  accuracies.* 


*Vehicle  maneuvering  is  assumed  minimal  during  this  period. 
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The  CALM,  which  is  used  only  when  an  unaligned  platform  is  available, 
generates  initial  values  for  two  of  the  fundamental  inter frame  matrices  -- 
P/L  and  L/C  --  which  are  dynamically  updated  by  the  PLAM  in  subsequent  ADR 
or  IDR  operation.  (The  third,  A/P,  is  not  updated  based  on  prior  values, 
but  is  directly  computed  from  current  dynamic  platform  attitude  readouts.) 

In  addition,  the  CALM  accomplishes  any  required  coarse  erection  and  leveling 
of  a  rotationally  isolated  IMU  (this  is  of  course  not  possible  for  a  strap- 
down  IMU)  .* 

When  CALM  operation  --  which  runs  in  parallel  with,  and  is  aided  by, 
reference  measurement -augmented  PDR  --  is  complete,  the  processor  is  ready 
for  sequencing  into  ADR  or  IDR,  depending  on  which  platform  is  available. 
When  both  are  available,  ADR  can  be  initiated  and  used  for  DR  naviga¬ 
tion  (using  the  prealigned  AHRU)  while  IMU  alignment  is  under  way. 


(b)  Switching  Modules 

These  modules  are  used  to  switch  between  DR  navigation  modes  and  between 
reference  navigation  measurement  configurations,  depending  on  navigation 
hardware  availability.  In  particular  the  DSWM,  RSWM,  and  KSWM  respectively 
accomplish  the  inter -DR-mode  switching  of  the  DR  modules,  the  inter-R- 
conf iguration  switching  of  the  R  modules,  and  the  corresponding,  intra-KF- 
module  D  and  R  substate  partitions  switching.  The  CSWM,  on  the  other  hand, 
switches  all  affected  D  and  R  module  variables  from  one  C  frame  to  another, 
when  required  and  specified  by  the  operator.  Kalman  module  variable  C  frame 
switching  is  embedded  as  a  KSWM  submodule.  The  switching  modules  are  dis¬ 
cussed  in  turn  in  the  following  paragraphs. 

The  DSWM  accomplishes  two  main  functions.  First,  it  selects  the  appro¬ 
priate  DR  mode  based  on  current  DR  navigation  equipment  availability.  Second, 
it  appropriately  initiates  CALM  operation  if  required  for  aggradation  to  ADR 
or  IDR,  initiates  any  new-mode-only  DR  module  variables,  and  sets  up  intra- 
DR  -module  execution  of  those  DR  module  subsets  appropriate  to  the  new  mode. 

The  RSWM  also  accomplishes  two  main,  corresponding  but  simpler  functions, 
since  the  R  modules,  unlike  the  D  modules,  are  essentially  mutually  inde¬ 
pendent.  First,  it  selects  which  R  modules  are  to  be  executed,  and  in  what 
mode  (e.g.  reference  altitude  modes)  based  on  current  R  navigation  equipment 
availability.  Second,  it  appropriately  initiates  any  new-signal  acquisition 
and  tracking  if  required  in  the  case  of  radio  pseudoranging  equipment, 
initiates  any  variables  required  by  start  or  restart  of  any  module,  and  sets 
up  intra-module  execution  of  the  selected  R  modules  in  the  appropriate  modes. 


*Only  passive  processor  interfacing  with  the  AHRU  is  assumed  in  the  current 
processor  definition.  The  AHRU  is  assumed  to  be  independently  aligned  prior 
to  its  use  by  the  processor,  which  at  no  time  generates  AHRU  torquing  rate 
controls,  but  only  passively  uses  its  attitude  inputs  in  conjunction  with  TAS 
to  conduct  ADR  navigation. 
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The  KSWM  carries  out  KF  module  switching  which  is  compatible  and  syn¬ 
chronous  with  both  DR  navigation  mode  and  R  configuration  switching.  Since 
such  switches  can  occur  at  a  faster  rate  in  certain  situations  than  the  KF 
cycling  rate,  the  KSWM  sets  up  temporary,  mode-change-type-dependent 
bypassing  of  certain  KF  modules  conducting  lower  priority  functions,  in 
favor  of  modules  conducting  higher  priority  functions,  to  conserve  time 
with  minimal  impact  on  accuracy.  For  example,  if  the  switch  involves  a 
DR  mode  change  only,  then  all  KF  measurement  use  and  control  operation 
modules  are  temporarily  bypassed,  to  enable  the  prediction  modules  (KTMM, 
KTUM)  to  maintain  error  estimate  and  covariance  matrix  continuity  and 
currency  despite  the  time-consuming  DR  error  model  switching  operations  which 
the  mode  switch  requires.  On  the  other  hand,  if  the  switch  involves  only 
an  R  configuration  change,  then  only  the  KCOM  needs  to  be  bypassed  (to  avoid 
time-consuming  adjustment  of  its  prediction  operation,  since  the  changes  to 
the  measurement  use  modules  are  trivial  and  require  little  time). 

Because  of  the  D  and  R  module-oriented  Kalman  filter  state  partitioning, 
maintaining  continuity  and  currency  of  the  error  estimate  and  covariance 
matrix  at  a  mode  or  configuration  switch  reduces  to  implementation  of  the 
following  simple  rules; 

•  Discontinue  updating  of,  and  discard  all  preswitch-only  substate 
estimate  vectors  and  covariance  matrix  partitions. 

•  Continue  updating  (using  new-mode  updating  relationships)  of  all  pre- 
and  postswitch-common,  substate  estimate  vector  and  covariance  matrix 
part  it  ions. 

•  Initialize  and  initiate  new-mode  updating  of  all  postswitch-only,  sub¬ 
state  estimate  vectors  and  covariance  matrix  partitions. 

Finally,  the  CSWM,  in  conjunction  with  the  Kalman  filter  C  frame 
switching  submodule  of  the  KSWM,  switches  all  DR,  R,  and  KF  module  variables 
which  are  C  frame  referenced,  to  their  new  values  with  respect  to  the  new 
C  frame.  In  order  to  simplify  overall  processor  switching  requirements, 
these  variable  transformations  are  delayed  until  the  end  of  the  KF  cycle  in 
which  the  operator  has  initiated  the  C  frame  change,  and  are  then  executed 
in  a  single  pass  through  the  required  computations. 


g.  Special  Processor  Concepts  and  Capabilities 

This  subsection  deals  with  a  variety  of  special  concepts  and  capabilities 
associated  with  the  processor,  which,  because  they  are  of  unusual  interest 
and  value,  need  emphasis.  There  are  three  main  areas  treated  here:  (1) 
switchable  uniframe  navigation,  (2)  Kalman  filter  partitioning,  and  (3) 

Kalman  filter  measurement  preprocessing  techniques.  These  are  discussed 
in  turn  in  the  following  paragraphs. 
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(1)  Switv/.iable  Uniframe  Navigation 


The  generalized  mission  requirements  constraints  on  processor  design 
outlined  in  subsection  2  above  included  in  particular  the  need  to  navigate 
in  any  of  a  variety  of  either  geodetically  or  locally  referenced  coordinates 
on  missions  of  different  types,  or  even  in  different  phases  of  the  same 
mission . 

The  approach  adopted  to  simplify  and  unify  processor  characteristics 
in  this  regard  consisted  in  the  selection  of  a  single  type  of  earth-fixed, 
Cartesian  coordinate  frame  in  which  the  basic  navigation  computations  could 
be  executed,  independent  of  mission  type.  On  missions,  or  during  mission 
phases,  where  global  navigation  is  required,  this  frame  is  earth  fixed  and 
earth  centered,  with  its  orthogonal  axes  aligned  along  the  principal  axes  of 
the  earth  (i.e.,  polar  and  equatorial  axes);  on  the  other  hand,  on  missions, 
or  during  mission  phases,  where  localized  navigation  is  needed,  although 
still  earth-fixed,  the  frame  is  now  centered  at  some  convenient  local  point 
(e.g.,  the  touchdown  point  in  ILS) ,  and  the  axes  are  aligned  in  some  locally, 
operationally  convenient  way  (e.g.,  along,  across,  and  vertical  to  the  run¬ 
way).  A  significant  property  of  these  frames,  since  they  are  nonrotating 
with  respect  to  one  another  (both  are  fixed  in  the  earth) ,  is  that  the  basic 
navigation  and  navigation  error  behavior  are  almost  exactly,  functionally 
the  same  for  both  frames.  Thus  essentially  the  same  navigation  and  Kalman 
filter  update  equations  can  be  used  by  the  processor  for  global  or  tactical 
missions,  or,  with  appropriate  (and  simple)  navigation  variable  switching 
at  transition,  for  missions  involving  both  global  and  tactical  phases. 

The  processor  therefore  essentially  carries  out  continuous  navigation 
in  and  with  respect  to  a  single  type  of  coordinate  system  throughout  any 
mission,  using  essentially  a  single  set  of  overall  navigation  computations. 
User  position  initialization,  emitter  position,  and  other  local  reference 
point  position  and  velocity  data  must  of  course  be  transformed  from  the 
coordinates  in  which  it  is  available  into  this  central  computational  frame, 
so  that  all  relative  navigation  and  guidance  can  be  carried  out  uniformly 
within  this  frame.  The  generalized  vector-matrix  equations  which  underlie 
this  capability  are  derived  in  Appendices  II,  III,  IV,  and  V. 


(2)  Kalman  Filter  Partitioning 

The  breakdown  of  the  overall  state  vector  into  a  set  of  module-related, 
partitioned  substates  has  been  discussed  earlier.  This  outlines  the  basic 
concepts  of,  and  advantages  provided  by  the  partitioning. 


The  fundamental  unpartltloned  (full  state)  Kalman  filtering  operations 
are  (a) the  time  update  or  prediction  operation*  (h)  the  measurement  update 
or  filtering  operation.  Both  of  these  are  essentially  updating  operations 
on  the  state  vector  (x)  and  its  associated  covariance  matrix  (P) . 

The  mathematical,  full-state  formulations*  are: 

•  Time  Update 


$  =  A<t>  (4>o  *  I) 

(1) 

X  =  <f>X 

(2) 

P  =  <t>?  <bT  +  R 

(3) 

Measurement  Update 

b  =  PMT/Q  (Q  =  MIWT  +  C)"1 

(4) 

x  =  x  +  b  (Y  -  Mx) 

(5) 

P  =  P  -  QbbT 

(6) 

where  A  is  the  overall  error  state  differential  equation  coefficients  matrix, 
<i>  is  the  error  state  transition  matrix,  R  is  the  error  state  noise  matrix, 

Y  is  the  measurement,  M  is  the  measurement  matrix,  C  is  the  measurement 
noise,  and  b  is  the  gain  vector. 

The  partitioning  of  the  full  state  x  is  defined  by: 


x 

n 


where  each  x  (s  *  l,2...,n)  is  a  module-oriented,  partitioned 
x.  The  corresponding  partitions  of  A,^,  P,  R,  b,  and  M  (Y  and 
scalars)  are  all  double-indexed  to  indicate  the  substates  they 
A  ,  is  the  set  of  error  state  differential  coefficients  which 

8  S 

couple  the  error  substate  s  into  the  error  substate  s. 


substate  of 
C  are  assumed 
relate;  e.g. , 
dynamically 


*These  have  been  purposely  simplified,  and  simplifying  assumptions  have 
also  been  made  about  some  of  the  retained  auxiliary  matrices  (i.e.,  Y 
and  C  are  scalars),  to  maintain  clarity  of  ideas. 
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laws  of  matrix  algebra,  equations  (1)  through  (6) 
into: 

above  can  be 
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i,  and  j  all  range  from  1  to  n. 

The  required  summations  in  these  equations  can  either  be  simplified  or 
in  many  cases  even  entirely  eliminated  by  appropriately  ordering  and  organ¬ 
izing  the  selected  substates.  For  example,  if  A  is  organizable  into  a 
pseudodiagonal  form  (this  is  in  fact  the  case  with  the  combined  R  substates) 
then  (7)  through  (9),  for  the  R  substates,  reduce  to: 
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For  another  example,  if  A  is  organizable  into  a  pseudo  upper-diagonal 
form  (this  is  in  fact  the  case  with  the  combined  D  substates  in  any  mode) 
then,  assuming  say,  that  A  and  4  have  the  partitioned  structures: 


An  Ai2 

0 

4 

11 

4 

12 

4 

13 

0  A22 

A?3 

4  *  s 

0 

4 

22 

4 

23 

O 

o 

_ J 

A33. 

0 

0 

4 

33  J 

*It  con  be  straightforwardly  demonstrated,  using  the  well-known  properties 
of  the  transition  matrix  [all  of  which  are  based  on  equation  (1)]  ,  that  if 
A  has  the  structure  shown,  then  4  must  have  the  structure  shown. 


31 


then  (7)  through  (9)  (for  the  D  substates)  would  reduce  to: 
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In  (16),  (17),  and  (18),  full  advantage  has  been  taken  of  the  structures 
of  A  and  <f>,  to  edit  out  almost  all  null  ^  and  A  submatrices. 

In  particular,  equations  ( 1 A) ,  (15),  (17),  and  (18)  constitute  a  very 
attractive  basis  for  the  design  of  the  KTUM  module.  The  programmer,  who  is 
always  primarily  concerned  with  the  critical  program  execution  time-versus- 
storage  requirements  balance  tradeoffs,  has  at  his  disposal  a  set  of  com¬ 
pact,  completely  indexed  (and  indexed  in  a  D  and  R  module-oriented  way), 
already  fast  (because  nearly  all  null  submatrices  have  already  been  edited 
out)  equations,  in  which  is  embedded  a  small  set  of  easily  identifiable, 
candidate  common  vector-matrix  subroutines  (summation  and  multiplication). 

He  can  optionally  --  depending  on  his  requirements  and  the  computer  involved  -- 
increase  speed  by  uniformly  straightlining,  instead  of  indexing,  all  indicated 
operations  and  subroutines,  or  at  the  other  extreme  he  can  decrease  speed  (but 
reduce  storage  requirements)  by  fully  indexing  all  operations.  Intermediate 
decisions  result  in  intermediate  speed  versus  storage  consequences. 

A  similar  programing  flexibility  with  regard  to  the  filtering  module 
(KFIM)  design  is  inherent  in  equations  (10)  through  (12),  where  in  particular 
an  added  flexibility  in  programming  is  obtained  by  noting  that  the  indicated 
summations  need  be  carried  out  only  for  the  substate  indices  which  have  non¬ 
null  relationships  with  the  measurement  Y;  i.e.,  with  the  non-null  submatrices 
of  M.  For  example,  if  the  measurement  Y  is  a  simple  two-way  range  measurement 
taken  synchronously  with  the  KF  cycle  enopolnt,  then  only  the  position  sub¬ 
state  partition  of  M  (which  is  simply  the  unit  LOS  vector  transposed)  is  non¬ 
null  (assuming  that  propagation  errors  are  not  modeled),  and  therefore  only 
the  index  corresponding  to  the  position  error  substate  need  be  considered  in 
the  summations  shown  in  equations  (10)  and  (11). 

Correspondingly,  equations  (13)  and  (16)  furnish  an  equally  attractive 
starting  point  for  KTMM  module  algorithm  design.  Note  that,  because  of  the 
structure  of  A,  the  on-(pseudo)  diagonal,  DR  transition  submatrix  differ¬ 
ential  equations  generated  by  equation  (16)  are  of  the  same  simple,  autono¬ 
mous  form  as  those  of  equation  (13).  This  means  that  independent  solutions 
can  be  generated  for  all  of  the  (pseudo)  diagonal  transition  submatrices. 
Further,  careful  examination  of  equation  (16)  leads  to  the  conclusion  that 
the  off-diagonal,  substate-coupling  transition  submatriccs  can  also  be 
separately  (but  not  independently)  generated,  using  the  on-diagonal  sub¬ 
matrix  solutions  as  forcing  functions. 
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All  the  non-null  partitions  of  the  overall  transition  matrix  can  there¬ 
fore  be  generated  separately,  some  completely  autonomously,  others  forced  by 
the  autonomous  solutions.  These  partitions  can  then  of  course  serve  as 
direct  and  natural  inputs  to  1CTUM  time  update  operations  based  on  equations 
(14),  (15),  (17),  and  (18).  Further,  the  fact  that  they  can  be  generated 
separately  allows  for  the  very  attractive  possibility  that  each  can  be  up¬ 
dated  at  a  rate  consistent  with  its  own  dynamics  (i.e.,  its  own  A  matrix). 
That  is,  those  transition  submatrices  whose  dynamics  are  essentially  con¬ 
stant  over  one  or  more  KF  cycles  need  be  computed  only  that  often,  while 
those  whose  dynamics  are  rapidly  changing  can  be  updated  as  fast  as  necessary 
within  each  KF  cycle.* 


(3)  KF  Measurement  Preprocessing 

This  paragraph  discusses  the  wide  variety  of  KF  measurement  preprocess¬ 
ing  techniques  which  have  been  considered  in  this  development  to  date.  Some 
of  these  were  and  are  in  common  use,  while  others,  to  the  author's  knowledge, 
are  original  with  Northrop  during  this  development.  In  any  event,  all  are 
important  design  tools,  not  only  for  preprocessing  the  range  of  reference 
navigation  measurement  types  which  have  been  considered  to  date  for  processor 
use  (i.e.,  radio  pseudorange,  altitude,  and  visual  position  fix  data),  and 
which  have  largely  motivated  the  development  of  these  techniques,  but  for 
other  reference  measurement  sensor  types  as  well  (e.g.,  doppler  radar, 
stellar  and  landmark  trackers,  etc.). 

There  are  in  all  five  broad  areas  considered  in  the  following  para¬ 
graphs;  (a)  raw  measurement** /KF  estimate  synchronization  (KMMM) ;  (b)  time 
smoothing  of  the  measurements  of  a  single  type  over  all  or  part  of  the  Kalman 
cycle  (also  KMMM);  (c)  combination  of  measurements  of  different  types  (both 
linear  and  nonlinear  combination)  (KMCM) ;  (d)  statistically  optimal,  ordered 
selection  of  measurements  of  different  types  (KMOM) ,  and  (e)  reasonableness 
testing  (KMRM) .  In  general,  it  Is  empnasized  that  whether  none,  some,  or  all 
of  these  techniques  at  present  should  be  employed  in  a  given  application,  and 
in  what  order,  seems  to  depend  to  a  large  extent  n  what  the  mission  and 
hardware  background  to  the  particular  application  is.  This  whole  important 
area  needs  further  attention  to  fit  the  processing  tools  defined  here  to  the 
mission  and  system  hardware  requirements  in  as  generally  applicable  a  manner 
as  possible. 


*Th i s  attractive  approach  can  in  fact  be  implemented  as  described  if  KF  meas¬ 
urements  are  only  taken  synchronously  with  the  KF  cycle  endpoints.  If 
measurements  interior  to  the  KF  cycle  ire  used,  however,  difficulties  arise 
because  partial-cycle  transition  submatrices  may  be  additionally  required  to 
synchronize  such  measurements  with  the  KF  cycle  endpoints.  In  such  cases, 
frequency  of  generation  of  even  the  slow-dynamics  dependent  transition  sub¬ 
matrices  (but  only  those  needed  for  synclronization)  may  be  governed  by  tbe 
measurement  data  rate.  This  important  area  needs  further  attention. 

,f*I.e.t  the  single  sample,  uutually  synchronous  D/R  reference  measurement  /DR 
differences. 
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(a)  KF  Meaaurement/Estimate  Synchronlzatlon*(KMKM) 

Figure  4  depicts  the  timing  of  KF  measurements  relative  to  the  KF  end- 
points,  with  which  KF  processor  error  estimates  are  synchronized. 

Consider  a  single,  synchronous,  raw  measurement- difference**  Y^ ,  taken 
Interior  to  the  KF  cycle.  The  time  Atp  ^  In  Figure  4  then  represents  the 
fundamental  asynchronlsm  between  the  measurement  of  actual  processor  state 
x^  at  time  t^,  and  the  time  tp  for  which  the  filter  computes  Its  estimate 

of  the  actual  processor  state  Xp. 

Mathematically,  the  relationship  between  the  measurement  and  the 
true  processor  error  state  at  tp,  Xp,  Is  simply:*** 


Y1  “  M1 ,F  *F  +  vi 


(19) 


where  v.  Is  measurement  noise  and  M.  _  is  the  observation  matrix;  i.e.,  the 
1  1  |F 

linear  relationship  between  the  measurement  Y^  and  the  actual  state  Xp  which 

the  filter  Is  estimating.****  M.  _  can  in  particular  be  written: 

l  ,F 


M 


i.F 


"l  l  ,F 


(20) 


where  is  the  linear  relationship  between  Y^  and  x^  (the  true  state  at 

time  t^,  which  Y^  directly  measures)  and  ^  p,  the  (backward)  error  state 

transition  matrix  from  time  t_  to  time  t . . 

F  t 

To  synchronize  the  measurement  Y^  to  the  error  state  estimate  for 
time  tp,  Xp,  the  processor  KF  measurement-residual  Is  therefore  formulated 
as  (Y^  •  y  Xp) ,  to  compensate  the  effects  of  actual  error  state  transition 
In  the  Interval  Atp  Failure  to  do  this  fl.e.,  use  of  just  (Yt  -  M1  Xp)]  , 
can  lead  to  serious  errors  In  KF  operation. 


*See  also  Appendix  XII. 

**It  is  emphasized  here  again  that  synchronous,  0/R  measurement  differ¬ 
encing  essentially  removes  vehicle  dynamics,  leaving  only  the  dynamics 
of  processor  error  in  its  overall  estimates  (e.g.,  VSTM  position  and 
velocity)  of  vehicle  dynamics. 

***Syatem  error  state  noise  and  control  have  purposely  been  neglected  here 
to  simplify  the  dlscuscion. 

****See  Appendix  VI. 
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For  example,  suppose  Y^  is  e  two-way  range  measurement,  so  that, 

neglecting  propagation  errors,  Y^  is  essentially  a  measurement  of  the 

component  of  processor  position  error  along  the  line  of  sight  (and  the 
position  error  partition  of  is  in  fact  just  the  transposed  unit  LOS 

vector) .  If  a  significant  uncompensated  velocity  error  exists  along  the 
LOS  at  the  time  of  measurement,  then  use  of  the  uncompensated  residual 
formulation  above  is  tantamount  to  neglecting  that  part  of  the  position 
error  at  tp  due  to  propagation  of  the  velocity  error  at  time  t^  in  the 

interval, At_  . .  The  accuracy  of  both  KF  position  and  velocity  error 
Ff  1 

estimation  could  therefore  be  significantly  affected. 

The  compensation  actually  applied  is  more  general  than  Implied  by  this 
example,  taking  additionally  into  account  (1)  any  control  rates  applied  to 
the  estimator  (e.g.,  those  modeling  the  leveling  control  rates  actually 
applied  to  the  IMU  in  IDR)  in  the  At^  ^  Interval,  since  these  can,  inde¬ 
pendently  of  other  effects,  produce  significant  velocity  errors,  and  (2) 
vehicle  dynamics -dependent  velocity  errors  generated  by  vehicle  maneuvers 
in  the  At  .  interval  (e.g.,  velocity  errors  produced  in  IDR  by  platform/ 

computer  misalignments  during  aircraft  maneuvers). 


(b)  Measurement  Time  Smoothing  (KMMM)* 

If  the  number  of  measurements  Y^  (for  the  moment,  assumed  here  to  be 

of  a  single  type;  e.g.,  all  LOS  pseudoranging  measurements  on  a  single 
emitter)  in  a  single  KF  cycle  is  large,  then  time  smoothing  techniques  -- 
to  an  extent  and  in  a  form  governed  by  many  factors  —  can  be  applied. 

These  techniques,  like  the  measurement  combination  techniques  dis¬ 
cussed  in  paragraph  (c) ,  are  desirable  to  the  extent  that  they  reduce  the 
number  of  measurements  which  must  be  processed  by  the  time-consuming  KFIM 
operations  (l.e.,  the  actual  Kalman  filtering  of  the  measurements)  into  a 
smaller,  prefiltered  set  of  measurements.  When  they  are  used,  accuracy 
is  thus  traded  off  to  gain  execution  time. 

Perhaps  the  simplest  epproach  is  to  straightforwardly  average  the  data 
Y^;  l.e.,  use  the  average: 

Y  -  ~  v  Y.  (21) 

n  i-l  1 

as  a  Kalman  filtet  measurement.  Generalising  on  the  results  of  paragraph 
(a),  however,  such  a  measurement  should  be  compensated  by  use  of  the  obser¬ 
vation  matrix:  _  n 

Mp  -  i  Z  Mi  *l|P  (22) 

♦See  Appendices  VII  and  VIII. 
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Generation  of  this  matrix  is  simplified  (1)  if  the  data  is  equispaced; 
(2)  if  the  M^  ;an  be  treated  in  common  as  a  constant  matrix  (e.g.,  if  the 

emitter  is  a  distant  navigation  satellite,  so  that  its  LOS  is  nearly  fixed), 
and  (3)  if  the  pertinent  submatrices  of  <f>  depend  on  only  slowly  varying 

dynamics  (e.g.,  the  vehicle  is  not  maneuvering).  Under  these  special  cir¬ 
cumstances,  can  be  computed  in  a  single,  closed-form  computation.  If 
significant  data  rate  irregularity,  LOS  directional  change,  and/or  vehicle 
dynamics  are  present,  however,  Mp  must  be  computed  recursively,  which  re¬ 
quires  a  computation  corresponding  to  each  measurement  in  the  average.  The 
extent  to  which  executing  these  relatively  more  time-consuming  recursive 
computations  is  feasible  depends  on,  among  other  things,  computer  speed  and 
processor  accuracy  requirements  for  the  particular  application  being 
considered . 

_If  the  measurement  data  rate  is  sufficiently  high,  either  formulation 

for  M_  (recursive  or  single-pass)  can  be  simplified  by  condensing  (i.e.,  pre- 
r 

averaging)  the  measurements  over  short  time  intervals  onto  the  interval 
centerpoints  and  using  these  as  a  basis  for  generation.  For  example,  if 
the  measurement  data  were  such  as  to  much  more  densely  cover  the  KF  cycle 
interval  shown  in  Figure  4,  it  might  be  profitably  condensed  into  n  measure¬ 
ments  Y^,  Y2 ,  ...,  Yn ,  each  consisting  of  the  local  average  of  the  actual 

measurements  centered  on  t^ ,  t^ ,  ...,  tn  and  could  be  computed  as  if 

there  were  only  n  measurements.  The  viability  of  this  technique  is  of 
course  dependent  on  the  adequate  plus-and-minus  cancellation  of  local 
velocity-into-position  error  propagation  effects  over  the  short  averaging 
intervals. 


(c)  KF  Measurement  Combination  (KMCM) 

To  this  point,  the  discussion  has  focused  on  preprocessing  KF  measure¬ 
ments  of  a  single  type.  This  paragraph  deals  with  the  precombination  of 
different  types  of  raw  (or  KF  endpoint-synchronized  or  time  smoothed)  KF 
measurement  differences  before  KFIM  use.  Two  principal  types  of  measurement 
combination  are  discussed  here:  linear  and  nonlinear.  Of  these,  several 
generally  applicable  linear  techniques  are  discussed,  the  purpose  of  each 
of  which  is  principally  --  like  the  linear  time -smoothing  techniques  dis¬ 
cussed  above  --  to  reduce  the  computational  load  on  the  computer  at  some 
(as  yet  unknown)  cost  in  accuracy.  On  the  other  hand,  only  a  single,  more 
or  less  special-purpose,  but  quite  important  nonlinear  combination  algorithm 
is  discussed,  whose  purpose  is  to  enable  use  by  the  Kalman  filter  of  LOS  net 
pseudoranging  data  in  the  face  of  large  LOS  directional  uncertainties. 


•  Linear  Techniques;  Two  specific  techniques  --  space  averaging,  and 
the  familiar  hyperbolic  differencing  --  are  discussed  here;  there  is 
also  a  final,  brief  general  discussion  of  other  linear  techniques. 


•  Space  Averaging;*  One  of  the  problems  often  associated  with  use 
of  a  Kalman  filter  to  accomplish  statistically  optimum  radio 
psuedoranging,  is  the  need  to  carry  a  large  --  and  therefore 
computationally  costly  --  propagation  delay  error  model  in  the 
filter.  This  technique  can  prove  valuable  in  such  situations 

by  eliminating  the  need  for  such  a  model. 

Given  a  set  cf  either  actually  simultaneous  multichannel-derived 
or  computationally  synchronized**  single-channel-derived  range 
measurement  differences  from  a  number  of  different  emitters,  this 
technique  involves  simply  first  converting  each  of  these  into  a 
corresponding  LOS  error  vector,  vectorially  averaging***  all  of 
these  vectors,  and  using  the  resulting,  average  error  vector  as 
a  KFIM  (single  3x1,  or  three  lxl)  measurement.**** 

The  underlying  rationale  here  is  simply  that  since  the  emitter 
directions  will  tend  to  be  uniformly  distributed,  the  error  in 
the  averaged  measurement  will  be  significantly  reduced.  For 
example,  if  all  the  n  emitters  are  producing  data  of  the  same 
statistical  quality,  then  the  standard  deviation  of  the  radial 
error  associated  with  their  average  is  1/n"  times  that  associated 
with  any  one  of  the  vectors  separately. 

•  Hyperbolic  Differencing;  This  well-known  technique,  viewed  from 
the  standpoint  of  the  more  general  pseudoranging  process  (of 
which  it  is  a  special  case),  implemented  by  the  processor,  is 
another  special-purpose,  linear  measurement  combination  technique. 

This  technique,  which  essentially  consists  of  linearly  differ¬ 
encing  pseudoranging  measurements  in  pairs,  thereby  eliminates 
emitter  net-receiver  clock  phase  difference  from  the  resulting 
measurements.  There  is  therefore  also  no  need  to  carry  a  storage- 
and  time-consuming  clock  error  model  in  the  Kalman  filter. 


*See  Appendix  VII. 

**E.g.,  KF  endpoint -synchronized,  using  the  technique  described  earlier. 

***This  can  be  a  simply  weighted  average  if  emitters  of  several  different 
types  are  involved. 

****The  KFIM  observation  matrix  used  to  process  this  averaged  measurement 

is  a  simple  function  of  the  LOS  directions  and  the  endpoint-synchronizing 
observation  matrices  associated  with  all  of  the  measurement  differences. 
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Although  there  is  no  geometrical  loss  in  positioning  accuracy 
resulting  from  hyperbolic  differencing  of  two  or  more  pseudo¬ 
ranging  measurements  (as  opposed  to  separately  processing  them)*, 
there  is  a  loss  in  both  accuracy  and  operational  capability,  in 
that  single-emitter  data  cannot  be  used  (unless  a  clock  error 
model  is  carried).  This  latter  fact  therefore  represents  the 
central  tradeoff  between  the  two  approaches. 

•  Other  Linear  Combination  Techniques:  In  the  KMCM  module,  pro¬ 
vision  is  made  for  assigning  weights  to  the  pseudoranging  measure¬ 
ments  to  be  combined  in  a  general  way,  which  is  not  restricted 
solely  to  those  special  weights  associated  with  the  space  averag¬ 
ing  and  hyperbolic  techniques  discussed  above.  This  has  been 
purposely  done  to  allow  for  future  inclusion  of  other  linear 
combination  techniques. 

•  Nonlinear  Technique:**  An  important  processor  design  problem  in  the 
LOS  pseudoranging  area  centers  on  the  proper  use  of  LOS  net  pseudo¬ 
ranging  measurements  in  prospective  operational  situations  where  the 
user/emitter  relative  (3_d)  position  uncertainties  are  comparable  in 
size  to  the  actual  user-emitter  ranges  themselves.  This  produces 
large  LOS  directional  uncertainties  which  preclude  KFIM  use  of  the 
normally  formulated  pseudoranging  measurement  differences  in  con¬ 
junction  with  their  attendant,  normally  formulated  observation 
matrices,  since  the  linear  measurement-state  relationships  inherently 
assumed  in  the  latter  no  longer  hold. 

Two  common  operational  situations  in  which  this  problem  can  occur  are 
(1)  navigation  start-up  with  LOS  data  when  little  or  no  information 
about  vehicle  position  with  respect  to  the  net  is  known,  and  (2) 
switching  from  globally  referenced  (e.g.,  NAVSAT-aided)  navigation  to 
locally  referenced  (e.g.,  target  area  LOS  net-aided)  navigation,  when, 
although  the  vehicle  position  is  accurately  known  in  the  E  frame, 
because  the  local  emitter  net  tie-in  to  the  E  frame  might  be  coarse, 
vehicle  position  relative  to  this  net  is  again  uncertain. 

Northrop  has  discovered***  a  very  attractive  technique  for  solution  of 
this  problem,  which  allows  Kalman  filter  estimation  of  vehicle  position 
no  matter  how  large  (but  of  course  within  the  computational  range  of 
the  computer  employed)  the  relative  vehicle-emitter  net  position 
uncertainty. 

*There  is  a  common  misconception  that  the  hyperbolic  technique  suffers 
uniquely  from  "gdop”  problems  near  emitter  net  baselines  and  their 
extensions.  The  fact  is  that  the  rho-rho  and  the  pseudoranging  tech¬ 
niques  suffer  identically  in  this  regard  --  i.e.,  all  three  techniques 
are  equally  geometry-sensitive. 

**See  Appendix  IX. 

***May  1972.  First  published  in  the  Multilateration  P!">se  II  Status 
Report  No.  1,  Period  11  May  to  10  June  1972. 
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The  technique  simply  involves  using  simple,  nonlinear  combinations  of 
the  pseudoranging  measurements  in  pairs  (instead  of  the  individual 
linear,  separate,  emitter  measurements  one  by  one)  as  direct  KFDf 
input  measurements.  These  nonlinear  pair  combinations  are  such  as  to 
produce  an  exact  measurement-state  relationship  (i.e.,  observation 
matrix)  and  thus  remove  the  difficulty. 

This  important  and  promising  technique  --  like  the  statistically 
optimal  measurement  selection  technique  discussed  below  --  in  particular 
merit  further  investigation,  development,  and  evaluation. 


(d)  Optimal  Measurement  Selection  (KMOM)* 

When  several  different  types  of  radio  position  fixing,  ranging,  range- 
rating,  and  altitude  data  are  simultaneously  available,  appropriate  sequencing 
and/or  selection  logic  must  be  Incorporated  in  the  processor  to  afford  best 
use  of  the  data  in  the  real  time  available.  Such  logic  can  range  all  the 
way  from  that  required  simply  to  implement  the  operator's  selections  at  all 
times  to  that  necessary  to  automatically  select  and/or  sequence  on  a  more 
sophisticated  basis,  subject  at  most  to  occasional  operator  overrides.  One 
design  approach  to  the  latter  philosophy,  which  has  the  advantage  that  is 
is  naturally  compatible  with  the  Kalman  estimation  theory  and  algorithms, 
is  as  follows.  A  unique  feature  of  any  Kalman  (or  modified  Kalman)  naviga¬ 
tional  filter,  and  one  which  might  be  put  to  advantage  in  designing  the 
measurement  selection  logic  of  the  processor,  consists  in  the  incorporation 
of  its  own  error  statistics.  That  is,  an  error  covariance  matrix  which 
embodies  the  estimated  variances  and  covariances  of  the  errors  in  the  various 
navigation  error  variables  being  estimated  is  automatically  (and  necessarily) 
carried  and  updated  as  an  integral  part  of  the  overall  filter  algorithm  com¬ 
putations.  In  particular,  one  set  of  computations  which  is  routinely  per¬ 
formed  whenever  a  new  measurement  is  used  by  the  filter  produces  a  covariance- 
change  matrix  whose  diagonal  elements  represent  the  error  variance  decrements 
which  reflect  the  improved  quality  of  the  new  estimate  resulting  from  use  of 
the  new  measurement. 

If  sets  of  these  variance-decrement  elements  --  one  set  for  each 
measurement  --  were  computed  for  all  of  several  simultaneously  available 
measurements  of  different  types  in  advance  of  their  actual  use  by  the  filter, 
these  could  be  used  as  a  basis  for  several  types  of  rather  conceptually 
attractive,  automatic  measurement  selection  algorithms. 

For  example,  suppose  that  it  were  desired  during  a  particular  phase  of 
a  mission,  to  select  measurements  so  as  to  minimize  vehicle  radial  position 
error.  Since  the  variance  of  the  radial  position  error  is  simply  the  sum 
of  the  three  variance  elements  in  the  covariance  matrix  which  correspond  to 
the  three  components  of  vehicle  position,  then  it  would  only  be  necessary 


♦See  Appendix  VII. 
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to  calculate  the  radial  position  error  variance  decrement  for  each  of  the 
available  measurements,  and  select  for  further  processing  that  measurement 
which  would  produce  the  largest  such  decrement.  This  process  could,  for 
example,  be  activated  by  the  operator  via  the  control  panel. 

As  another  example,  if  it  were  desired  during  the  weapon  delivery  phase 
of  a  mission  to  select  measurements  so  as  to  minimize  weapon  impact  miss 
distance,  then  an  extension  of  the  above  technique  could  be  used  to  accom¬ 
plish  this  as  follows.  The  extra  information  required  here  would  consist 
of  a  set  of  sensitivity  coefficients  which  linearly  related  the  miss  distance 
to  the  errors  in  the  appropriate  vehicle  navigational  variables  being  esti¬ 
mated  by  the  Kalman  filter.  Given  these  coefficients,  which  would  in  general 
be  expressable  terms  of  already  computationally  available  weapon  delivery 
variables,  a  set  of  miss  distance  decrements  --  one  for  each  measurement  -- 
could  be  computed,  and  that  measurement  which  yielded  the  largest  such 
decrement  selected  for  further  processing  from  among  the  candidate  measure¬ 
ments.  This  overall  process  might  also,  like  that  in  the  above  example,  be 
actuated  from  the  control  panel  as  a  selectable  operation.  The  essential 
mathematics  underlying  this  technique  is  also  summarized  in  Appendix  VII. 
However,  a  central  question  which  would  require  resolution  in  connection 
with  the  prospective  use  of  such  algorithms  revolves  around  whether  or  not 
the  time  to  execute  them  might  not  be  so  long  as  to  make  it  preferable  to 
omit  all  sophisticated  selection  logic,  and  simply  use  the  time  saved  in 
processing  as  many  measurements  through  the  filter  as  possible  in  accordance 
with  some  simple  cyclic  rule  instead. 

(e)  Measurement  Reasonableness  Testing  (KMRM)* 

Finally,  the  availability  of  built-in  Kalman  filter  error  statistics 
also  facilitates  the  incorporation  of  measurement  data  reasonableness  tests 
as  part  of  the  measurement  preprocessing  logic.  This  type  of  test  is  in 
wide  use  in  the  industry. 


Growth  Potential 


As  indicated  in  subsection  1,  the  scope  of  the  processor  developed  to 
date  is  limited  to  (j.)  basic  navigation  output  (3-d  positior,  3-d  velocity, 
and  vehicle-to-computer  frame  angular  transformation  and  angular  rate)  gen¬ 
eration  only,  and  (2)  processing  of  input  data  from  IMU,  AHRU,  CADS,  and 
radio  transceiver  pseudoranging  equipments  only. 


However,  the  flexibility  and  general izabil ity  which  have  been  carefully 
built  into  the  processor  structure  will  enable  easy  expansion  of  its  capa¬ 
bilities  to  also  include  (a)  processing  of  input  data  from  additional  navi¬ 
gation  sensor  types,  such  as  doppler  radar,  the  wide  class  of  angle-measuring 
or  angulation  (as  opposed  to  pseudorange  measuring,  or  ranging)  devices,  and 
(b)  processing  for  operations  closely  related  to  navigation,  such  as  steering, 
guidance,  weapon  delivery,  TLS,  etc. 


*See  Appendix  VII. 
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As  an  example  of  processor  navigation  processing  adaptability,  consider 
the  software  approach  to  use  of  a  strapdown  doppler  radar,  instead  of  CADS 
TAS  and  a  wind  estimate,  in  conjunction  with  AHRU  attitude  data  to  accomplish 
DDR  instead  of  ADR.* 

This  can  be  visualized  as  a  two-step  process.  First,  the  formulation  of 
a  doppler  data  processing  module  which  would  include  all  operations  necessary 
to  convert  raw  doppler  input  signal  data  into  error-compensated  frequency 
shift,  and  finally  into  3-d,  air frame -referenced ,  groundspeed  vector  data. 

The  functions  of  this  module,  like  those  of  the  processor  DR  modules  speci¬ 
fied  to  date,  would  be  organized  into  functionally  separate  and  distinct 
groups  to  allow  processing  at  different  rates  (or  even  complete  omission  of 
certain  functions),  and  formulated  in  vector/matrix  terms  (which  should  be 
widely  applicable  to  the  essentially  vector-measurement,  doppler  process)  to 
facilitate  common  subroutining  with  other  modules.  The  computations  of  this 
module  in  DDR  would  essentially  replace  those  of  the  MASM  in  ADR. 

Second,  the  DSWM  and  KSWM  (D  portion  only)  modules  would  require  minor 
modification  to  accommodate  DDR/PDR  switching  instead  of  the  (highly  similar) 
ADR/PDR.  Thus  essentially  only  two  already  available  processor  modules  would 
require  modification  --  and  those  only  slight  modification  using  already 
developed  techniques  discussed  in  this  document  --  without  otherwise  disturb¬ 
ing  the  main  body  of  processor  modules. 

An  an  example  of  extension  of  processor  techniques  to  other,  non¬ 
navigation  but  closely  related  avionics  functions,  consider  the  generation 
of,  say,  weapon  delivery  computations.  In  general,  such  computations  have 
the  following  suggestive  characteristics:  (1)  their  principal  outputs  — 
time  and/or  distance  and/or  velocity  to  go  before  weapon  release  or  launch  -- 
are  straightforwardly  formulable  in  terms  of  vector-matrix,  locally  referenced 
computations,  and  (2)  these  computations  usually  require  three-dimensional 
position,  velocity,  attitude  (and  sometimes  attitude  rate)  of  carrier  aircraft, 
as  well  as  three-dimensional  position  and  velocity  of  the  target  and  in  the 
same  reference  frame) , 

Overall,  therefore,  weapon  delivery  computations  could  be  formulated 
using  not  only  the  same  vector  matrix  techniques  as  already  developed  for 
processor  navigation,  but  navigation  processor  outputs  as  principal  (carrier 
vehicle  data)  inputs  as  well.  Such  a  formulation  would  of  course  not  only 
be  highly  compatible  with  the  navigation  processor  formulation  developed  to 
date,  but  would  share  its  intramodule  flexibilities  and  other  advantages  as 
well. 


♦Assuming  for  simplicity  in  this  discussion,  a  navigation  hardwar*  complement 
not  including  an  IMU,  but  only  an  AHRU. 
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SECTION  III 


PROCESSOR  MLI  SPECIFICATION 


This  section  presents  the  navigation  processor  specification  at  the 
machine-and-language-independent  (MLI)  level  of  definition.  Overall,  this 
section  is  organized  into  five  main  subsections,  largely  paralleling  the 
organization  of  the  modular  processor  itself.  These  are  (1)  an  initial 
description  of  the  overall  processor  modular  structure,  organization,  and 
information  flow,  followed  by  the  separate  descriptions  and  actual  MLI 
specifications  for  each  of  the  principal,  processor  modular  groups:  (2)  the 
DR  (D)  navigation  modules,  (3)  the  reference  navigation  measurement  (R) 
modules,  (4)  the  Kalman  filter  (K)  modules,  and  (5)  the  initialization  and 
switching  modules. 

Each  module,  whatever  its  module  group,  adheres  to  a  more  or  less 
standard  MLI  specification  format.  This  consists  of  a  brief  introductory 
description  of  the  specific  functional  role  of  the  module  with  regard  to 
overall  processor  operations,  followed  by  a  formal  specification  consisting 
of  one  or  more  of  each  of  the  following,  depending  on  the  modular  group  to 
which  the  module  belongs:  an  operations  summary  table,  an  input/output 
summary  table,  an  operations  flow  diagram,  a  logic  flow  diagram,  and  a  data 
flow  diagram.  Further,  each  module-subsection  is  intended  to  be  as  nearly 
self-contained  as  possible  from  a  programmer's  point  of  view;  i.e.,  given 
only  certain  minimal  additional  machine,  language,  and  application-specific 
information  (e.g.,  relative  frequency  of  execution  of  the  algorithms  com¬ 
prising  the  module),  he  could  actually  program  the  module  from  this  specifica¬ 
tion.  Consistent  with  this,  module  and  module  group-specifying  subsections 
in  this  section  have  been  arranged  as  separate,  pull-out  packages,  starting 
with  a  right-hand  page,  module  title  page,  and  ending  with  a  left-hand  page 
(which  is  blank  where  necessary  to  create  a  pull-out  package). 

Further,  the  submodular  organization  of  the  specification  for  each 
module,  although  largely  standardized,  still  allows  a  wide  flexibility  in 
such  important  areas  as  alternate-algorithm  substitution,  order  and  relative 
frequency  of  algorithm  execution,  and  so  forth. 

Finally,  the  depth  of  module  algorithm  definition  varies  with  the  module 
and  algorithm  involved,  in  accordance  with  the  degree  to  which  single, 
obviously  preferable  candidate  algorithms  can  or  cannot  be  specified  short 
of  further  machine,  language,  and  application-specific  information.  For 
example,  processing  of  IDR  specific  force  into  C-frame  velocity  and  position 
vectors  in  the  VSIW  can  be  accomplished  essentially  in  only  one  way  and  is 
so  specified;  on  the  other  hand,  the  vector  gravity  computation,  which  can  be 
accomplished  in  several  ways,  is  left  as  a  more  general,  input/output 
identification-level  specification  only.  Correspondingly  loose  algorithm 
specifications  are  also  used  in  particular  in  several  of  the  Kalman  filter 
modules  (e.g.,  KTW,  &WM)  where  both  closed-form  and  recursive  formulations 
are  available  for  the  same  algorithm,  the  selection  depending  on  the  appli¬ 
cation. 
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OVERALL  PROCESSOR  ORGANIZATION  SUMMARY 


Figure  5  is  the  overall  logic  data,  control  marker  flow,  and  module 
identification  diagram  for  the  navigation  processor.  In  particular,  the 
diagram  centers  on  the  dynamic  navigation  execution  loop  which  includes 
(a)  the  sequential  processing  of  the  three  main  navigation  update  module 
groups  --  i.e.,  the  DR  navigation  (D)  modules,  the  reference  navigation 
measurement  (R)  modules,  and  the  Kalman  filter  (K)  modules;  (b)  the  switching 
modules  necessary  to  control  the  use  of  these  module  groups  and  their  com¬ 
putational  reference  frame  i.e.,  the  DR  navigation  mode  switching  module, 

the  R  configuration  switching  module,  the  Kalman  filter  switching  module, 
and  the  C  frame  switching  module  --  and  (c)  the  platform-to-computer  coarse 
alignment  module.  In  addition,  the  loop  includes  provision  for  peripheral 
execution  of  any  of  a  variety  of  possible  navigation  output  computations 
(e.g.,  conversion  of  basic  navigation  processor  outputs  into  output  display 
coordinates  which  are  not  required  to  maintain  processor  basic  navigation 
but  use  its  outputs  as  inputs).  Finally,  there  are  two  modules  outside  the 
dynamic  navigation  loop  whose  sole  purpose  is  initial  startup  of  basic 
navigation. 

Entry  into  each  module  on  each  overall  navigation  loop  execution  cycle 
is  governed  by  a  marker -controlled,  module  use  decision.  These  markers  may 
in  general  be  set  (actually  or  conceptually)  by  any  01  all  of  the  following 
means;  (a)  operator  control,  (b)  hardware-controlled  computer  interrupts 
and/or  predetermined  (i.e.,  initial  input-controlled)  relative  frequency  of 
execution  data,  and  (c)  changes  in  DR  navigation  mode,  reference  navigation 
measurement  configuration,  and  platform-to-computer  alignment  status, 
controlled  by  the  DSWM  and  RSWM  modules. 

Of  these,  full  operator  control  should  probably  be  associated  with  the 
use  of  certain  modules  (e.g.,  CSWM,  since  the  operator  can  best  decide  just 
when  processor  navigation  with  respect  to  a  local  objective  area  emitter  net 
should  begin),  while  solely  automatic  control  should  perhaps  be  exerted  over 
certain  others  (e.g.,  the  Kalman  filter  modules,  since  the  computer  can  far 
more  quickly  assimilate  and  use  the  large  amount  of  relatively  cryptic, 
statistically  based  data  generated  by  the  filter).  However,  the  whole  area 
of  operator  versus  automatic  control  is  of  course  highly  dependent  on  the 
processor  application  and  its  particular  man-machine  interface  philosophy. 
Complete  processor  flexibility  in  this  regard  has  therefore  been  retained  by 
the  simple  device  of  allowing  for  the  capability  of  operator  intervention  of 
any  specified  degree  in  switching  modules. 

Whatever  the  degree  of  operator  versus  automatic  control  embedded  in  the 
DSWM,  RSWM,  KSWM,  and  CSWM  logic,  it  is  assumed  that  the  first  two  produce 
as  respective  outputs,  on  every  main  loop  cycle,  the  basic  DRMM  (DR  mode 
marker)  and  RMCMs  (reference  navigation  measurement  processing  configuration 
markers),  which  (a)  fully  control  the  use  and  internal  configuration  of  the 
D  and  R  modules  respectively,  and  (b)  via  the  KSWM,  control  the  use  of  only 
the  corresponding  appropriate  D,  R,  and  D/R  Kalman  filter  estimate  vector 
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and  covariance  matrix  partitions  by  each  of  the  K  modules.  The  KSWM  further 
controls  use  and  internal  configuration  of  the  K  modules  as  well.  Finallv, 
the  CSWM  controls  the  configuration  of  the  (limited)  C-frame-dependent 
portion  of  the  VSTM  module.  All  these  switching  modules,  in  addition  to  the 
control  functions  just  described,  also  execute  the  required  navigation 
variable  switching  attending  each  D  mode  and/or  R  configuration  change  for 
its  pertinent  module  group. 

Specification  of  an  appropriate  set  of  predetermined,  inter-  and  intra¬ 
module  relative  frequency  of  algorithm  execution  data  is  correspondingly 
left  entirely  open,  since  this  depends  heavily  on  the  carrier  vehicle 
dynamical  capabilities,  mission  accuracy  requirements,  computer  speed,  and 
so  forth,  associated  with  the  specific  processor  application  contemplated. 

A  summary  description  of  the  functions  performed  by  each  of  the  pro¬ 
cessor  modules  is  included  below  as  a  compact,  overall-processor,  companion 
reference  to  Figure  5. 


a.  Start-Up  Modules 

(1)  CONM:  Navigation  Constants  Initialization  Module:  Checks  for 
availability  of,  and  installs,  all  navigation  constants 
required  by  every  processor  module  for  the  given  navigation 
equipment  configuration. 

(2)  NSTM;  Navigation  Start  Module:  Initializes  C  frame  (C=E) , 
and  initializes  VSTM  and  KFMD  substates  for  PDR  start. 


b.  Switching  Modules 

(1)  DSWM:  DR  Nav  Mode  Selection/Switching  Module;  Selects  current 
DR  nav  mode,  based  on  current  DR  nav  equipment  output  data 
availability  and  operator  control.  Initializes  and  switches 

DR  module  and  coarse  align  module  variables  and  operations  as 
required  by  DR  mode  change. 

(2)  RSWM:  Ref  Nav  Measurement  Selection/Switching  Module; 

Selects  set  of  measurement  types  for  R  module  and  KF  module 
time  update)  processing,  based  on  current  reference  naviga¬ 
tion  measurement  equipment,  output  data  availability,  and 
operator  control.  Initializes  and  switches  R  module  variables 
and  operations  as  required  by  reference  navigation  processing 
set  change. 

(3)  KSWM:  Kalman  Filter  Switching  Module:  Initializes  and 
switches  Kalman  filter  module  D,  R,  and  D/R  substates  and 
operations,  as  required  by  changes  in  DR  nav  mode  or  ref 
nav  measurement  processing  configuration  or  computational 
reference  (C)  frame. 
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(4)  CSWMi  C  Frame  Switching  Module  (Non-KF  Modules) :  Initializes 
and  switches  D  and  R  module  variables  (or  substates)  and 
operations  as  required  by  C  frame  change  (operator  controlled) . 


c.  CALM;  Coarse  Align  Module:  Coarse  initializes  (IMU  or  AHRU) 
platform-to-computer  transformation  and  local  level -to -computer 
transformations,  and  coarse  levels  IMU  (as  required)  prior  to  IDR 
or  ADR  processor  operation. 


d.  DR  Nav  Modules 


(1)  VSIM;  Vehicle  State  Module;  Continuously  updates  vehicle 
state  (position  and  velocity)  in  C  frame. 

(2)  PLAM:  Platform  Module:  Continuously  computes  all  platform- 
use-related  quantities  necessary  to  provide  (a)  C  frame 
acceleration  inputs  to  VSTM  and  control  rates  to  platform 
control  loops  in  IDR,  or  (b)  VSTM  C  frame  velocity,  in  con¬ 
junction  with  UASM  operation,  in  ADR. 

(3)  WASM:  Wlnd/TAS  Modules:  Continuously  computes  (a)  C  frame 
wind  and  TAS  vectors  for  VSTM  velocity  determination  in  ADR, 
and  (b)  C  frame  TAS  vector  for  wind  determination  in  IDR. 


e.  Ref  Nay  Measurement  Modules 

(1)  ALTM:  Ref  Altitude  Module:  Continuously  computes  reference 
altitude,  based  on  RSWM-selected  reference  altitude  mode,  and 
synchronously  differences  with  VSTM-computed  altitude. 

(2)  POSM:  Position  Fix  Module:  Converts  panel-entered  visual 
position  fix  data  from  input  to  Internal  (C  frame)  coordinates, 
and  synchronously  differences  the  result  with  VSTM  position. 

(3)  TDPMs:  Transceiver  Data  Processlna  Modules;  Acquisition-  and 
rate-aids  radio  navigation  (ranging)  signal  processing  (TAAM) , 
defines  and  processes  emitter  data  word  signal  into  emitter 
position,  velocity  and  antenna  lever  arm  data  (TEWM)>  computes 
appropriate  antenna  lever  arm  corrections  for  the  TRRM  module 
(TALM),  computes  synchronous  VSTM/emltter  ephemerls  date-based 
range  and  range  rate  for  TMOM  use  (TRRM),  computes  signal  propa¬ 
gation  error  corrections  for  the  TMCM  module  (TPCM) ,  computes 
D/R  radio  measurement-difference  observables  (TMCM) ,  computes 
the  measurement  matrix  (DMO  and  measurement  data  statistics 
(TDSM)  for  KF  use  in  conjunction  with  the  TMCM  measurement- 
differences. 
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f .  Ka 1 man  Filter  Modules 


( 1)  KTUM:  KF  Estimate/Covariance  Matrix  Time  Update  Module: 

Time  updates  KF  estimate  and  attendant  covariance  matrix 
over  last  KF  cycle. 

(2)  KTMit  KF  Time  Update  Matrix  Generation  Module;  Generates 
current-cycle  time  update  matrices  for  use  by  KTUM  in  next 
KF  cycle. 

(3)  KMRM:  KF  Measurement  Reasonableness  Module;  Tests  last- 
cycle  measurements  for  reasonableness.  Rejects  unreasonable 
measurements  for  further  KF  processing. 

(4)  KMCM:  KF  Measurement  Combination  Module;  Linearly  combines 
some  or  all  of  the  set  of  reasonable,  last-cycle  measurements 
(i.e.,  the  set  passed  by  the  KMRM)  and  its  set  of  attendant 
measurement  matrices. 

(5)  KMOM:  KF  Measurement  Optimal  Selection  Module:  Optimally 
orders  the  set  of  last -cycle  linearly  combined  measurements 
for  use  by  the  KFIM. 

(6)  KFIM:  KF  Estimate/Covariance  Matrix  Filtering  Module;  Up¬ 
dates  the  KF  processor  error  estimate  and  its  attendant 
covariance  matrix,  using  the  set  of  last-cycle,  reasonable, 
and  linearly  combined  measurements  (and  their  attendant 
measurement  matrices)  which  are  outputted  by  the  KMRM,  KMCM, 
and  KMOM  modules.  Resulting  estimate  and  covariance  matrices 
are  synchronized  with  start  of  current  cycle. 

(7)  KMMM;  KF  Synchronized  Measurement  Matrix  Generation  Module; 
Generates  time-smoothed,  estimate-synchronized  measurement 
matrices  for  use  with  current  cycle  measurements  in  next  KF 
cycle. 

(8)  KCOM;  KF  Est inmte/Processor  Control  Module;  Generates  and 
executes  end-of-cycle  KF  estimate  and  non-KF  module  variable 
corrections  and  controls. 


g.  Special  Navigation  Output  Modules 

This  is  a  class  of  prospective,  special-purpose  modules,  which  use  nav 
processor  outputs  as  principal  inputs  (e.g.,  output  display  coordinate  computa¬ 
tion  module,  steering  signal  generation  module,  etc.) 
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III. 2 

DR  NAVIGATION  (D)  MODULES 
SPECIFICATIONS  SUMMARY 
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This  module  group,  which  executes  basic  DR  navigation,  consists  of  the 
central,  all-mode  (IDR,  ADR,  PDR)  Vehicle  State  Module  (VSTM) ,  augmented  by 
the  Platform  Module  (PLAM)  and  the  Wind/Airspeed  Module  (WASM)  in  IDR  or  ADR. 


The  specification  for  each  of  these  three  modules  is  composed  of  (a)  a 
brief  summary  description  of  the  module  functions,  (b)  a  DR  mode -dependent, 
module  operations  summary  table,  (c)  a  DR  mode-controlled,  module  operations 
flow  diagram,  and  (d)  a  DR  mode-dependent,  module  input/output  summary  table. 
In  particular,  use  is  made  throughout  each  specification  of  the  following 
DR  mode-use  set  mnemonics,  for  identifying  and  grouping  these  operations 
themselves,  as  well  as  their  inputs  and  outputs; 

I,P,A  =  IDR,  PDR,  ADR  modes,  respectively 

IPA  =  Set  of  Operations  (or  input/output)  common  to  I,  P,  and  A  modes 
IP  =  "  "  common  to  I  and  P  modes 

IA  =  "  "  common  to  I  and  A  modes 

PA  =  "  "  cixnmon  to  P  nd  A  modes 


I  = 


n 


exclusive  to  I  mode 


P  = 


ti 


exclusive  to  P  mode 


A  = 


exclusive  to  A  mode 


Thus,  for  example,  in  the  IDR  mode,  as  the  operations  flow  diagrams 
prescribe,  all  of  the  (non-null)  operation  sets  IPA,  IP,  IA,  and  I,  as 
identified  in  the  operations  summary  table,  need  to  be  executed,  and  the 
corresponding  input/output  requirements  are  summarized  against  these  sets 
in  the  input/output  summary  table. 


The  relative  frequency  of  execution  of  each  of  the  separate  operations 
in  the  summary  table  is  purposely  left  unspecified,  since  it  is  highly 
application-dependent.  On  the  other  hand,  the  order  has  been  carefully 
selected  such  that,  if  followed  on  the  first  module  execution  cycle  in  any 
new  DR  mode,  it  leads  to  minimum  DSWM  navigation  variable  switching  require¬ 
ments.  If  another  order  is  used,  therefore,  the  DSWM  logic  and  operations 
must  be  carefully  reexamined  and  revised  as  necessary. 
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VEHICLE  STATE  MODULE 


(VSTM) 


SPECIFICATION 


This  module  operates  in  all  three  DR  modes. 

In  IDR,  operation  consists  of  resolution  of  PLAM-generated  specific 
force  into  the  C  frame,  its  compensation  for  gravity  and  Coriolis  accelera¬ 
tions,  and  its  integration  into  C-frame -referenced  velocity  and  position 
vectors. 

In  ADR,  the  C-frame-referenced  velocity  vector  is  computed  as  the  sum 
of  the  WASM-derived  airspeed  and  wind  vectors,  and  integrated  into  a  C-frame- 
referenced  position  vector. 

In  PDR,  an  L -frame -referenced  pseudoacceleration  vector  is  resolved  into 
the  C  frame  and  integrated  into  C-frame-referenced  velocity  and  position 
vectors.  The  pseudoacceleration  vector  is  also  appropriately  time-decayed. 

In  particular,  the  C-frame-referenced  vehicle  position,  velocity,  and 
gravity  vectors,  and  the  geoidal  altitude,  are  generated  in  all  three  DR 
modes . 
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085. 


Intra-KF  Cycle  Execution 


TABLE  V.  VSTM  OPERATIONS  SUMMARY 
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PLATFORM  MODULE 
(FLAM) 


SPECIFICATION 


This  module  operates  only  in  the  IDR  or  ADR  modes.  In  addition,  IDR 
operation  is  further  broken  down  into  strapdown  IMU-only  (IS)  and  rota- 
tionally  isolated  (free)  IMU-only  (IF)  operations,  and  ADR  operations  into 
those  which  are  required  only  when  the  AHRU  is  in  the  DG  mode  (AD) ,  and  only 
when  it  is  in  the  magnetic  mode  (AM). 

Whatever  the  DR  mode,  IMU  type,  or  AHRU  mode,  the  PLAM  always  generates 
the  following  principal  outputs;  (a)  the  basic  interframe  transformation 
matrices  and  relative  angular  rate  vectors  between  the  platform,  locally 
level,  and  (earth-fixed)  computer  frames,  and  (b)  (if  appropriate  platform 
readout  data  is  available)  the  corresponding  entities  relating  the  vehicle 
(=air)  and  computer  frames. 

In  addition  in  IDR,  the  PLAM  error-compensates  IMU  accelerometer  out¬ 
puts,  shapes  and  outputs  the  platform  frame-referenced  specific  force 
vector,  and  error-compensates  and  shapes  IMU  gyro  control  signals. 
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Figure  7.  PLAM  Operations  Flow 


Utra-Kf  Cycle  Execution 


TABLE  VII.  PLAM  OPERATIONS  SUMMARY 


Sti.ipiluvn  (1$) 


*ot ,  rnt  on 


AD*  (A) 

(DC  Mode  (AD)  I  m*  Mode  (AM) 


Earth  Kau-  |g^(  )l. 


Con  .la  I  Curvature 
Matrix 

L/C  Frame 

*"*•  ““  K/c)l 


K/t)p  «»> 


P/L  PtAM 
Rate  /u l,. 


P/L  Pram* 

Tranaf.  T, 


P/C  Prama 

*"»•  ,,1‘  H/c)p 

P/C  rrm 
Tronif.  T  . 


(“*  E/I )l  '  TL/rt/l 
.  Function  of  h  .(“k/ljL^/ll 

(I/cIl  ’  Vl  v 

tl/c  ■  Tl/c'Lcl/c  K/c  ^  *  Twc<l 


k  nsn 


,  OSJ) 


;“?•  Mi >'■)-  , ,  m.-*1 

*tp/l  jK/c)i+f“k/i)n 

i*:  Tf/t  ■  T»/f  L.r  H/l)p  *  Tp/tdi 


(“Wc)p  *  K/l)p  *  tp/l(h./c)l 


tp/c  ■  tp/ltl/c 


Platform  Specific 
Porca  f_ 


tt  •  Funct.  of 


Af  ■  Funct.  of 


£Ctb"‘n4T‘  *P-(-V/l)prACC  'P'^/I)*-^  f,,,) 

Pl.tfon.  &ut*  Funct.  o(  ..  ..  Du)"  Funct,  of 

'»,K/i)p,,CCC  ,r(“Vn)rKCC  ” 


fp  -  (^  ♦  M  * 


A/c  Frame 

T*a«a.  T. 


|  A/C  Frame 
An*.  Rut.  ^/c 


P/(  Pr*M  An*. 

(no)p (,r) 

(no)p  '(n/c/p  af„ 

*  tp/l(“V/i)l  *  Hk 

Cyco  Tsr*utn* 

RAtA  ufcn 

( *  •trepdov* 

Gyro  Seated  Rata) 

“fcr*  *  (n/i)p  *  **- 

A/P  Frame 

Tr.n.f .  Tk/f 

c*"  ■«) 

T./p  •  Funct.  of 
**”  /.PM 

I HU  Att.  R.Adout. 

T  •  Pune  t  .  v*» 

,r  mm 

AHRf  Att  .  Rr.«d  *«.!  •• 

A/P  Few*. 

An*.  RAtA  ^/fjr 

(N-)-  ’  ”) 

(n/p)p  ■  Fu"lt-  "  (iPAi 

IMU  Att.  A  Att.  Rate 

(n/p)r  * ” 

AHRU  Att  .Alt  .Air 

|  Readout i 

ta/c  *  ta/ptp/c 


"V/c  *  tp/cJH*/p)p  ‘  <“V/c)pi 


•  ■  v.ciaMa.  CantroOtO  by  RCOH  At  KP  Cytl.  EnApmnt. 

.  ,  .  ... 


v  *  nm  no/  .  /  *  \ 

*  p'f  .'T“  Wirrn  (•  *  n/i  *  •) 

,*  t  *n/ii 


TABLE  VIII.  FLAM  INPUT /OUTPUT  SUMMARY 


*C  Frame  Dependent 


WIND /AIRSPEED  MODULE 


(WASM) 


SPECIFICATION 


This  module  operates  only  in  the  IDR  or  ADR  modes. 

In  the  ADR  mode,  operations  involve  error-compensation,  shaping,  and 
C  frame  resolution  of  CADS  true  airspeed  and  L  frame  wind  estimates,  Into 
C  frame  airspeed  and  wind  vector  outputs.  In  addition,  the  wind  estimate 
is  appropriately  time-decayed. 

In  the  IDR  mode,  the  process  is  reversed,  and  an  L 'frame-referenced 
wind  estimate  is  continuously  determined  from  the  C -frame -referenced  air¬ 
speed  and  groundspeed  vector  difference.  In  particular,  the  groundspeed 
vector  used  is  just  the  VSTM  velocity  vector. 
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Figure  8.  WASM  Operations  Flow 


TABLE  IX.  WASM  OPERATIONS  SUMMARY 


DR  Nav  Mode 

Operation 

IDR(  I)  * 

ADR(A) 

PDR(P) 

Intra-KF  Cycle  Execution 

TAS 

Calibration  Aa 

(IA1) 

Aa  »  Function  of  a 

m 

Compensated 

TAS  • 

k  (IA2) 

*  ”  +  *  + 

TAS 

Angle  of  Attack 
Compensat ion 

T./.,,k  ,  ,  »  Functions  of  (1A3) 

A/A  A/A  An#le  o{  Attack 

TAS  Vector 

(vas)a  (a  Fr*"e) 

(IAA) 

(VAs)A  *  TA/A*kA/A*  - 

TAS  Vector 

VAS  (C  Frame) 

•u  ■  T»/cM»  <IA5> 

Wind  Vector 

Vy  (C  Frame) 

vw  ■  v  *  VAS  <U) 

V  -  T  !  M  (A2> 

W  ‘L/C\  W/L 

Wind  Vector 

(vw)l  (l  Fr,me) 

/v  \  a  T  /  V  (12) 

(vw)l  tl/cvw 

.  **  (Al> 
(vw)l  *  qwl(vw)l 

KF  Cycle 
Endpoint 
Fxecut ion 

*With  TAS  available.  This  module  Is  not  used  In  IDR  if  TAS  is  not  available, 
k:  Variables  controlled  by  KCOM  at  KF  cycle  endpoints. 


**o 


Wl 


.  ...  _  'kWLiitW  ,  1 

*  Diagonal  Matrix  with  Terms  e  ;  .  -  — 

"Li  T, . 

ULl 
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*C  Frame  Dependent 


III. 3 


L 

L 

L 

L 

[ 


REFERENCE  NAVIGATION  MEASUREMENT  (R)  MODULES 

SPECIFICATIONS 


j 

[ 


71 


There  are  three  of  these  modules,  corresponding  to  the  three  types  of 
reference  navigation  measurement  data  assumed.  These  are  (a)  the  reference 
altitude  module  (ALTM) ,  (b)  the  position  fix  module  (POSM) ,  and  (c)  the 
transceiver  data  processing  module  (TDPM) . 

Unlike  the  D  modules,  where  a  high  degree  of  interrelationship  between 
modules  exists,  the  R  modules  are  essentially  independent  of  one  another, 
and  each  R  module  specification  is  therefore  arranged  by  itself  in  this 
subsection  as  a  separate,  pullout  package. 
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Ill . 3  .a 


REFERENCE  ALTITUDE  MODULE 
(ALTM) 

SPECIFICATION 


73 


Operation  of  this  module  depends  partly  on  whether  the  aircraft  is  on 
the  ground  or  in  the  air.  When  airborne,  the  best  available  reference 
altitude  —  barometric  altitude  from  the  CADS  or  pseudo  altitude  in  its 
absence  —  is  continuously  selected  and  updated  by  this  module.  This 
reference  altitude  is  then  synchronously  differenced  with  DR  altitude 
computed  by  the  VSTM,  for  measurement  preprocessing  use  by  the  Kalman  Filter 
Measurement  Matrix  Generation  Module  (KM«!M) . 

On  the  ground  (where  it  is  assumed  that  panel -inserted  field  altitude 
is  always  available)  field  altitude  is  selected  as  the  best  available 
reference  altitude  when  the  barometric  altitude  is  not  available;  when 
available,  barometric  altitude  itself  --  continuously  corrected  to  equal 
the  field  altitude  —  is  selected  instead.  Kalman  filter  use  of  this  data 
does  not  commence  until  the  vehicle  is  airborne. 
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Figure  9.  ALTM  Operations  Flow 


TABLE  XI.  ALTM  OPERATIONS  SUMMARY 


■h 


Ref  Altitude 
N.  Mode 

Operation'*-. 

Air  (A) 

Ground (G) 

Pseudo  Alt 
(No  Baro  Avail) 

Baro  Alt 
Available 

Field  Alt 
Plus  Baro  Alt 

Field  Alt 
Only 

APS 

AB 

GFB 

GF 

Intra-KF  cycle 

|  Execution 

Ref  Alt 

bR 

\  •  hPctAPS1> 

\-»BC  <B1> 

h  -  h  <GF1> 

R  F 

Corrected 

Baro  Alt 

(AB1) 

hBC  *hB+AhBK 

(GFB1) 

hBC=hF 

Corrected 
Pseudo  Alt 
hpc  Update 

h  «h<APS2> 
PC  PC 

+kh^hPC'hCR^ 

(GF2) 

hpc-lV 

AhfiK  Corr'n 
(Ground) 

(GFB2) 

AhBK=hF"hB 

Synchronous 
Alt  Diff  Ah 

Ah  -  h  -  hR 

Note:  Ah  ,h  Corrected  by  KF  in  Airborne  Modes  only. 
BK.  PC 


TABLE  XII.  ALTM  INPUT /OUTPUT  SUMMARY 


Alt 

Mode  — ► 

APS 

AB 

GFB 

B 

G 

BG 

APS/GF 

A 

Input 

hCR,kh 

AhBK 

1 

• 

• 

• 

»B 

i 

l 

• 

l 

l 

1 

1 

1 

1 

h 

Output 

.... 

.... 

ihBK 

^BC 

.... 

h__ 

PC 

Ah 

REFERENCE  POSITION  FIX  MODULE 
(POSM) 


SPECIFICATION 


This  module  converts  panel- inserted  visual  position  fix  data  from  input 
coordinates  to  an  internal  C  frame-referenced  position  vector,  and  syn¬ 
chronously  differences  this  vector  with  the  DR  position  vector  generated 
by  the  VSTM. 
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TABLE  XIII.  POSM  OPERATIONS  SUMMARY 


Intra-KF-Cycle 

Execution 

Ref  Position 
Vector  pR 
Generation 

p  =  Function  of  Panel 
Input  Position  Fix 
Coordinates 

Synchronous 
Position  Diff. 
Ap 

Ap  «  p  -  pR 

TABLE  XIV.  POSM  INPUT/OUTPUT  SUMMARY 


Input 

p.  Panel  Input  Position 
Fix  Coordinates 

Output 

Pr,  4P 
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III.3.C 


TRANSCEIVER  DATA  PROCESSING  MODULES 
(TDFM) 

SPECIFICATIONS  SUMMARY 
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The  fundamental  TDPM  submodule  organization  la  shown  In  Figure  10. 

The  module  Interface  to  the  receiver  Is  defined  by  the  two  Inputs  which  consist 
of  the  received  data  word  message  and  the  basic  range  and  range  rate  signals 
measured  by  the  receiver.  An  acquisition  and  aiding  signal  is  provided  to  the 
receiver  interface  from  the  TDPM.  Three  Intramodule  outputs  are  provided  by 
the  TDPM:  (a)  the  filter  variances  provided  by  the  TDSM,  (b)  the  measurement 
matrix  elements  generated  by  the  TM4M,  and  (c)  the  Kalman  filter  observable  data 
obtained  from  the  TMOM.  Elements  of  the  Kalman  filter  estimates  are  provided 
for  correction  to  several  other  modules  within  the  TDPM  to  complete  the  Intra¬ 
module  interfacing. 

Two  data  bus  outputs  dominate  the  submodule  interfacing.  These  are  the 
basic  emitter  word  data  vector  generated  by  the  TWQi  and  the  scalar  range  and 
rate  information  developed  by  the  TRBM.  These  two  dominant  information  flows 
govern  the  operation  of  the  other  six  submodules  and  only  two  other  Intermodule 
interfaces  are  required  to  complete  the  functional  architecture. 
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Figure  10.  TDPM  Modules  Organization/Receiver  Interface 
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III.3.C. (1) 


TRANSCEIVER  ACQUISITION  AND  AIDING  MODULE 
(TAAM) 

SPECIFICATION 
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The  receiver  acquisition  and  signal  tracking  processes  are  enhanced  if 
information  is  provided  defining  the  initial  phase  and  phase  rate  and  current 
deviations  in  this  data.  For  a  time  division  multiplexed  system  (TDM)  the 
estimated  time  of  arrival  of  the  emitter  signal  is  also  indicated  to  the 
receiver.  Rate  aiding  in  terms  of  the  phase  derivatives  allows  for  narrowband 
tracking  within  the  receiver  loops. 
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mm  i-'f 


Intra-KF -Cycle  Execution  (Once  per  Emitter  Type  j) 


TABLE  XVI .  TAAM  INPUT /OUTPUT  SUMMARY 


Input  Constants 

K  *  range-to-phase  conversion 

t 

K«  ~  veloc ity-to-phasfc-rate  conversion 

<t> 

A Td  *  computational  delay  constant 


Input  Variables 

t  *  user  receiver  time  base  (lxl) 

tl 


A^t  -  cumulative  KF  emitter  clock  error  correction  (lxl)  ) 


TEWM 


|RJ' 

l*jl 


•  • 


unit  jth  emitter  I«OS  vector  (3x1) 


\ 

estimated  scalar  range  to  jth  emitter  (lxl) 
estimated  range  rate  to  jth  emitter  (lxl) 

KF  position  error  covariance  matrix  (3x3) 

KF  velocity  error  covariance  matrix  (3x3) 


I 

j  TRRM 


measured  range  acceleration  vector  in  computational 
frame  (3x1)  (if  available) 


Output  Variables 

tj  ■  time  of  arrival  of  jth  emitter  for  TDM  systems 

-  phase  Initialization  for  receiver  acquisition 

■  phase  rate  initialization  for  receiver  acquisition 

-  phase  search  extent  for  receiver  acquisition 
&0j  »  phase  rate  extent  for  receiver  acquisition 
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III. 3. c. (2) 

TRANSCEIVER  EMITTER  WORD  MODULE 
(TEWM) 

SPECIFICATION 
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The  demodulated  serial  bit  data  stream  which  is  processed  by  each  emitter 
receiver  is  converted  to  distinct  emitter  position  and  velocity  states  by  this 
module.  The  other  elements  of  the  data  word  which  contain  information  on 
emitter  dynamics  or  on  propagation  constants  are  simply  throughputted  to  other 
modules.  The  basic  emitter  states  are  also  corrected  to  maintain  the  updated 
value  suitable  for  navigation.  The  data  word  may  also  contain  time  base  data, 
in  terms  of  total  state  values  or  in  terms  of  emitter  time  offsets.  If  no 
data  word  time  base  is  given,  the  user  receiver  time  state  is  based  on  the 
user  clock  with  corrections. 


Figure  12.  TEWM  Operations  Flow 


TABLE  XVII.  TEWM  DATA  WORD  INPUTS 


Transceiver 
N.Con  f  i  gur  a  - 

D*ta  Word 

Ground 
Emitter  (G) 

Airborne 
Enitter  (A) 

Satellite 
Emitter  (S) 

Tine  Base 

‘j 

Position 

Not  required 

6j 

Not  required 

Velocity 

Not  required 

‘j 

Not  required 

Antenna  Arm 

Not  required 

(d0ij  )a 

Not  required 

Direction  Cosine 

Not  required 

tc/aemj 

Not  required 

Attitude  Rate 

Not  required 

UkBij/C 

Not  required 

Surface 

Refraction 

N. 

Satellite 

Coefficient 

Not  required 

Aji 

Ionosphere 

Coefficient 

Not  required 

| 

I 

i 

I  < 

1 


Intra-KF“Cycle  Execution  fOnce  per  Emitter  Type  j) 


TABLE  XVIII.  TEWM  OPERATIONS  SUMMARY 


Transceiver 
^>s*^vCon  f  igura - 

^^^v^tion 

Operations 

Ground 
Emitter  (G) 

Airborne 
Emitter  (A) 

Satellite 
Emitter  (S) 

Initialization  of 

Time  t' 
u 

t*  *  t. 

u  J 

(with  data  word) 

(GAS  1) 

0 

a 

t'  ■  t  (no  data  word) 
u  u 

(GAS  2) 

Corrected  Time  t 

u 

t  -  t'  +  L,t 
u  u  “K  u 

(GAS  3) 

Delay  Time  tp 

Not  required 

VVj+llil (sl) 

C 

c 

2 

c 

Determination  of 
Emitter  Position 

ej  •  ej[0] 

e'  »  data  word 

J  (Al) 

Y'VV  <S2> 

'•4 

4J 

3 

U 

0 

X 

•1 

eTO]»constant 

e;  *  v*/ 

Ji-0  J  J  (S3) 

Determination  of 
Emitter  Velocity 

6\ 

J 

Not  required 

e'  »  data  word 

J  (A2) 

l.J.  e\*  (S4) 

j  at  J 

1 

r> 

w 

aJ 

C 

Corrected 

Emitter 

Position  e* 

e .  ■ 
J 

e'.  +  A..e  . 

J  K  J 

(GAS 4) 

Correa  ted 

Emitter 

Velocity 

Not  required 

•  •  . 
c  *  c  .  +  i.  c 

Cj  ej  s-  <y-j 

1 

(AS1>| 

•  • 
may  be  formed  by  an  alternate  series  of  e^ 


n 

■  L 

i-0 


J  i 


(0 


C  ■  speed  of  l ight (constant) 


TABLE  XIX.  TEHM  INPUT /OUTPUT  SUMMARY 


Inputs; 


Agtj  -  cumulative  XF  amittar  clock  error  correction  (lxl) 

Agtu  ■  cumulative  KF  user  receiver  clock  error  correction  (lxl) 

tu  -  user  receiver  time  base  (lxl) 

|Rj|  ■  estimated  scalar  range  to  the  jth  emitter  (lxl) 

■  cumulative  KF  emitter  position  error  correction  (3x1) 

AgAj  ■  cumulative  KF  emitter  velocity  error  correction  (3x1) 

Data  Word  ■  demodulated  serial  bit  stream  consisting  of  the  following  data; 
tj  -  emitter  time  base  (lxl) 

ej  ■  emitter  position  vector  for  jth  emitter  (3x1) 
e'  -  emitter  velocity  vector  for  jth  emitter  (3x1) 


(dBij)A 

TC/AEMj 

“JtfMj/C 


antenna  lever  arm  (3x1) 

airframe-to-C~frame  transformation  wTix  (3x1) 
airframa-to*C~ frame  angular  rate  (expressed  in  C  frame)  (3x1) 
surface  refract ivity 

satellite  position/velocity  polynomial  coefficient  (lxl) 
satellite  ionospheric  correction  polynomial  coefficient  (ixl) 


Outputs; 


Data  word  elements  of: 


V 


Input  to  TRXM 


C/AEMj  /  input  to  TA1M 


*AM)/C 


T  input  to  TPCM 

Jo 

t  Input  to  TAAM 
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III. 3. c. (3) 

TRANSCEIVER  ANTENNA  LEVER  ARM  MODULE 
(TALM) 

SPECIFICATION 


97 


The  compensation  for  antenna  position  and  angular  rate  about  the  compu¬ 
tational  frame  point  defined  by  the  platform  requires  the  use  of  location  and 
attitude  rate  data.  The  inclusion  of  emitter  antenna  motion  for  airborne 
relay  transceiver  configuration  requires  additional  emitter  reporting  data 
which  specifies  antenna  location,  attitude,  and  attitude  rate  in  aircraft 
coordinates  or  in  a  common  computational  reference  frame. 
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TABLE  XX.  TALM  OPERATIONS  SUMMARY 


Transceiver 

^""•^fjonfigura- 

^''-«K>><<tion 

Operations 

Ground 
Emitter  (G) 

Airborne 
Emitter  (A) 

Satellite 
Emitter  (S) 

In tra-KF “Cycle  Execution  (Once  per  Emitter  Type  j)* 

User  Antenna 
Displacement 

d„  -  tc/a  Kl  (CAS1> 

Emitter  Antenna 
Displacement 

dEMj 

Not  required 

(Al) 

dEMj 

TC/AEMj  (dEM^A 

Not  required 

Antenna  U?er 
Velocity  du 

du  ■  “X/C  X  du  (GAS2) 

Emitter  Antenna 
Velocity  dm 

— 

Not  required 

(A2) 

dEMj  * 

“AD»/C  X 

Not  required 
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TABLE  XXI.  TALM  INPUT /OUTPUT  SUMMARY 


I 

i 

» 


Inputs 


(dJ, 


to 


A/C 


A/C 

^AEMj/C 

(d  .) 

‘  EMj  > A 

TC/AEMj 


user  antenna  lever  arm  in  aircraft  coordinates  (3x1) 

angular  attitude  rates  of  user  aircraft  with  respect  to 
computational  C  frame  (3xl) 

transformation  from  C  frame  to  airframe  (3x3) 

jth  emitter  air frame-to-C-frame  angular  rate  (3x1) 

jth  emitter  lever  arm  in  emitter  aircraft 

jth  emitter  a ir f rame -to-C-frame  transformation  (3x3) 


Output s  (in  C  frame) 

d  =  user  antenna  lever 
u 

d  =  user  antenna  lever 


dEMj 

dEMj 


jth  emitter  antenna 
jth  emitter  antenna 


arm  displacement  (3x1) 
arm  displacement  rate  (3x1) 
lever  arm  displacement  (3x1) 
lever  arm  displacement  rate 


1x1) 


i 


III. 3. c. (4) 

TRANSCEIVER  RANGE  AND  RANGE  RATE  MODULE 
(TRRM) 

SPECIFICATION 
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The  determination  of  the  scalar  range  and  range  rate  to  each  emitter  is 
estimated  from  data  on  the  emitter  and  user  vector  dynamics.  Various  compensa 
tions  for  antenna  and  emitter  dynamics  are  incorporated  to  provide  high  ac¬ 
curacy  for  each  emitter  type.  The  vector  pointing  direction  in  the  form  of  a 
unit  vector  quantity  is  also  determined  to  provide  the  coordinate  frame 
orientation  for  the  transceiver  measurements. 


TABLE  XXII.  TRBM  OPERATION  SIMMARY 


Transceiver 

Configura- 

tion 


Operations 


Uaer/jth  Emitter 
C,  Vector  Range 

«  R* 

a  J 


E  LOS  Range  |r^| 


o  unit  LOS  Vector 

C  'j 
O  J 


)S  Range  Rate 


Ground 
Emitter  (G) 


Airborne 
Emitter  (A) 


Rj  ■ p  +  "-j 


|Rjl  ■  fo)' 


rJ  -  Rj/lRjl 


Satellite 
Emitter  (S) 


d  -  (GS 1) j  d-cL-d  <Al>  d  "  <*u  <GSl) 


(GAS  1) 


(GAS  2) 


(GAS  3) 


d"du"dEMJ 

d  -  du  (GS2) 

\  (AS1) 

1/ 

'tJ.  . 


TABLE  XXIII.  TRRM  INPUT /OUTPUT  SUMMARY 


Inputs: 


e . 
J 

e . 
J 


TEWM 


=  jth  emitter  position  vector  (3x1) 

=  jth  emitter  velocity  vector  (3x1) 

=  estimated  receiver  position  vector  (3x1)  | 
=  estimated  receiver  velocity  vector  (3x1)  j 


VSTM 


EMj 

’emj 


TALM  Outputs 


Outputs: 

| Rj |  =  estimated  scalar  range  to  jth  emitter  (lxl) 

I Rj |  *  estimated  range  rate  to  jth  emitter  (lxl) 

r.  =  unit  vector  along  iine-of-sight  to  jth  emitter  (3x1) 


(p+d)  *  vector  velocity  to  emitter  (3x1) 
(p+d-ejl  ■  vector  velocity  to  emitter  (3x1) 


Input  to  TMMM 
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III. 3. c. (5) 

TRANSCEIVER  PROPAGATION  CORRECTION  MODULE 
(TPCM) 

SPECIFICATION 


‘ 


l 
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The  modelable  errors  for  llne-of -sight  propagation  corrections  for 
transceiver  configurations  are  the  tropospheric  velocity  change  and  ray 
bending  and  the  ionospheric  group  delay  for  satellite  emitters.  These 
corrections  are  based  on  physical,  empirically  derived  models  which  employ 
various  parameters  as  Inputs  to  generate  the  compensations.  Basic  emitter- 
user  geometry  is  also  tested  to  ensure  that  the  most  suitable  emitter  is 
employed  to  generate  the  desired  navigation  information. 
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Figure  15.  TPCM  Operations  Flow 


Xntra-KF -Cycle  Execution  (Once  per  Salt ter  Type  j) 


TABLE  XXIV.  TPCM  OPERATIONS  SUMtARY 


Transceiver 
^■'^Con  figure  • 

Ground 

Airborne 

Satellite 

^"■"•^tlon 

Emitter  (G) 

Emitter  (A) 

Emitter  (S) 

Operations 

LOS  Angle  "  T  "  TTT  (CAS1) 

0  J  J  M 


Negative  Angle 
Check 

Not  required 

1*1  >  l*jl  (*i) 

Not  required 

Redefine 

LOS  Angle 

Not  required 

0  — r*  -^5-  (A2) 

1  >  |'t| 

Not  required 

Satellite 

Availability 

Not  required 

<  5*  (SI) 

Tropospheric 

Correction 

*»tj 

4-  .  .  ,V  <GA1) 

^TJ  (sin^j+Cj  P 

Additional  (S2) 
Algorithm 

Low  erasing 

Angle 

<  3*  (GA2) 

Not  required 

Redefine 

LOS  Angle 

fj  ■  v 

>j**  (GA3) 

Not  required 

Additional 

Bending 

Correction 

*®Tj  ’  *J  <CA4) 

Not  required 

Ionospheric 

Correction 

Not  required 

*IJ  *  ' 

^  (S3) 

Total 

Correction 

dp, 

rj  +  *  V-j  ■ 

(CAS  2) 
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TABLE  XXV.  TPCM  INPUT /OUTPUT  SUhWARY 


Inputs; 

p  -  estimated  receiver  position  vector  (3x1) 
r^  =  unit  vector  along  line-of-sight  to  jth  emitter  (3x1) 

e^  =  jth  emitter  position  vector  (3x1) 

Ng  =  surface  refractivity  J  TEWM 

4  L.  =  cumulative  KF  jth  link  propagation  error  correction  (lxl) 

K  J 

$v  -  electron  content  (may  be  calculated  from  I  coefficient  of  TWQi) 


Constants; 


^  *  tropospheric  constant 


Cj  ■  atmospheric  constant  or  functional  parameter  of  altitude 
P  •  exponent  constant 


(*)  <**) 


bending  angle  error  which  may  be  defined  either  as  a  function  or 
as  a  tabulated  parameter  of  /9 j 

indicates  potential  expanded  algorithm 


■  bending  constant 


Kj  ■  ionospheric  constant 
f  -  frequency 

*  tropospheric  constant  or  functional  parameter 

Outputs: 

-  total  propagation  correction  (to  THOM) 
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III. 3. c. (6) 


TRANSCEIVER  MEASUREMENT  OBSERVABLES  MODULE 
(TMOM) 

SPECIFICATION 
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I  The  basic  measurement  data  provided  to  the  Kalman  filter  estimation 

algorithm  is  the  difference  between  the  computed  and  measured  values  of  range 
and  range  rate.  All  known  propagation  link  range  and  range  rate  errors  must 
also  be  corrected  before  making  this  comparison.  The  pseudorange  and  range 
rate  time  offsets  due  to  both  emitter  and  user  clock  biases  are  applied  as 
I  1  range  correction  terms. 

I  '? 


TABLE  XXVI.  TM0M  OPERATIONS  SUMMARY 


Transceiver 
^^■^Con  f  igura - 
^"-•s^tion 
Operations 

Ground 
Emitter  (G) 

Airborne 
Emitter  (A) 

Satellite 
Emitter  (S) 

Intra-KF -Cycle  Execution  (Once  per  Emitter  Type  j) 

Measured  Range 
and  Range  Rate 
Scaling 

pit  OH 

R  raj’  mj 

«"mJ  -  <GAS1> 
R"  -  Kjij  (GAS2) 

Measured  Range 
Propagat ion 
Correction 

R'  i 

mj 

R'mj  "  R"mj  +  ^mj  (GAS  3) 

Measured  Range 

Rate  Propagation 

Correction 

R'  . 
mj 

*Vj  -  +  <GAS4> 

Measured  Range 

Clock-Difference 

Correction 

R  i 

mj 

VR,«j  +  c(V«Vj)  <G''S5> 

Measured  Range 

Rate  Clock  Rate- 
Diff.  Correction 

R  4 
mj 

■  R,»j  +  c  (Vu-Vj) 

Range  Difference 
Observable 

yrj 

YRJ  ■  lRji  -  Rmj  <GAS7> 

Range  Rate 
Difference 

Observab le 

Y 

RRj 

yrrj  ‘  (GAS8> 

K1KZ  ■  constant*  for  scaling  frotn  receiver  to  computer  units 
C  *  speed  of  light 
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TABLE  XXVII.  TMOM  INPUT /OUTPUT  SUMMARY 


Inputs: 


R  . 
mj 


|Rjl 

Vj 

Vu 

Vj 

A„t 
K  u 

AR  . 
mJ 

AR  . 
mj 

Outputs: 

* 

yrj 

* 

Y 

RRj 


corrected,  scaled  measured  pseudorange  from  jth  receiver  channel**  (lxl) 
corrected,  scaled  measured  pseudorange  rate  from  the  jth  channel**  (lxl) 
scalar  range  estimate  (lxl)  ) 

TRRM 

range  rate  estimate  (lxl)  ) 

cumulative  KF  emitter  clock  error  correction  (lxl) 
cumulative  KF  user  clock  error  correction  (lxl) 
cumulative  KF  emitter  clock  rate  error  correction  (lxl) 
cumulative  user  clock  rate  error  correction  (lxl) 
propagation  range  correction  (lxl) 


propagation  range  rate  correction  (lxl)  j 


TPCM 


From 

KF 


observable  range  error  (lxl) 


observable  range  rate  error  (lxl) 


Inputs  to  KF  Measurement 
Preprocessing 


*In  the  KF  Partitioned  Structure  Specification,  the  indices  R  and  RR  used  here 
and  in  the  TMMM  and  TDSM  modules  are  respectively  denoted  simply  by  3  and  4 

**i.e.,  from  jth  emitter  via  jth  receiver  channel 


III. 3. c. (7) 


TRANSCEIVER  MEASUREMENT  MATRIX  MODULE 
(TMMM) 

SPECIFICATION 
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The  measurement  matrix  elements  relating  the  measured  observable  to  the 
error  states  are  specified  by  this  module.  The  user  and  emitter  position  and 
velocity  errors  are  determined  in  terms  of  the  unit  LOS  (direction  cosine) 
vector.  The  elements  for  time  and  link  propagation  errors  are  also  established 
by  functional  terms,  end  ere  related  to  the  range  or  range  rate  observations 
by  using  the  speed  of  light  and  by  stipulating  a  single  propagation  error  state. 
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Intra-KF -Cycle  Execution  (Once  per  Emitter  Type  j)* 


TABLE  XXVIII.  TMMM  OPERATIONS  SIMCARY 


♦Unless  otherwise  noted  by  en  eeterlek  to  indicate  only  one  execution  per 
emitter  group, 

**D  -  (I-YjVIRjI 
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TABLE  XXIX.  TMMM  INPUT /OUTPUT  SUMMARY 


Inputs; 


|Rj|  =  estimated  scalar  range  to  jth  emitter  (lxl) 

r^  =  user/ jth  emitter  unit  LOS  vector  (3x1) 

•  • 

(p+d)  =  antenna  velocity  w/r  to  fixed  emitter  (3x1) 


(p+d-e^)  =  antenna  velocity  vector  w/r  to  moving  emitter  (3x1) 


Outputs:  Measurement  matrix  elements  defined  according  to  the 
following  convention: 


TRRM 


M 

Range-Dif f . 
Measurement 

Range -Rat e-D if f . 
Measurement 

Error 

States 

MR6p 

\r6p 

6p 

(=  user  position  error) 

MR6t 

u 

^Rfie. 

J 

0 

6e. 

6t 

u 

(=  emitter  position  error) 

(*  user  clock  error) 

MR6t. 

J 

0 

6t. 

(■  emitter  clock  error) 

^fiL 

0 

6L 

(*  link  propagation  error) 

0 

^Rfip 

6d 

0 

^fie^ 

6ej 

0 

^Rfit 

u 

fit 

u 

0 

^RRfit ^ 

fit. 

J 

*In  the  KF  Partitioned  Structure  Specification,  the  indices  6p,  6e . ,  etc., 
are  respectively  denoted  by  the  appropriate  value  of  the  KF  error Jsubstate 
index  s. 


III. 3. c. (8) 

TRANSCEIVER  DATA  STATISTICS  MODULE 
(TDSM) 

SPECIFICATION 
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The  emitter  data  provided  to  the  estimation  algorithm  within  the  Kalman 
filter  requires  an  estimate  of  the  measurement  noise  error  covariance  to 
properly  weight  the  information.  These  noise  statistics  depend  (a)  upon  the 
signal-to-noise  ratio  present  within  the  tracking  receiver  bandwidth,  and  (b) 
upon  tracking  errors  due  to  multipath  conditions  which  present  large  deviations 
between  the  measured  and  extrapolated  data.  Other  system  noise  error  statistics 
which  characterize  the  system  error  driving  noises  are  also  generated  by  this 
module. 


Intra-KF -Cycle  Execution  (Once  per  Emitter  Ty^e  j)* 


TABLE  XXX.  TDSM  OPERATIONS  SUMMARY 


Tranaceiver 

^■“^Con  figure  - 

Ground 

Airborne 

^"'-'^tion 

Emitter  (G) 

Emitter  (A) 

Operations 

Signal -to-Noiae 
Ratio,  a. 


Multipath  Teat 
Term,  Rpj 


Multipath  Teat 
Logic 


Emitter  Range 
Variance,  oRj 


Emitter  Rate^ 
Variance, 


Uaer  Time  Rate 
Variance,  or*  , 


Time 


Emitter  Tim 
Variance,  a 


Link  Error  _ 
Variance,  oL 


Total  Range 
Variance,  CRj 


Total  Range  Rate 
Variance,  CM. 


Satellite 
Emitter  (S) 


S/N  -  a. 


Receiver  Input 


(Calculated) 


>  K 

K2, 

m 

m 

<  K 

K 

m 

m 

e 

*  2 

v  X 

K  ' 

>  m 

m 

• 

• 

<  K 

K  ' 

re 

m 

<>ii m  +  * 


°i]  ■  vj1  + 


<  •  k3 


2  - 
aL  -S 


(GASl 


(GAS  2 


(GAS4 


(GAS  5 


(G\S  6 


(GAS 


(GAS  8' 


(SAS9 


(GAS11 


tot  4  I  Uter/jlli 


III. 4 


KALMAN  FILTER  (K)  MODULES 

SPECIFICATIONS 


133 


Taken  as  a  group,  these  modules  together  comprise  all  the  operations 
necessary  to  (a)  preselect  and  preprocess  raw  D/R  measurement -differences 
into  a  form  suitable  for  actual  Kalman  filtering  (KMMM,  KMRM,  KMCM,  KMQM) ; 
(b)  accomplish  Kalman  filtering  itself  (KFIM) ;  (c)  accomplish  estimate  and 
covariance  matrix  prediction  across  the  Kalman  interval  (between  filtering 
times  at  the  interval  endpoints  (KTUM,  KTMM) ,  and  (d)  compute  and  apply 
Kalman  estimate-derived  corrections  to  processor  (Kalman  and  non-Kalman) 
navigation  variables  (KCOM) . 

All  of  these  modules  are  partitioned  into  D,  R,  and  D/R  substate  opera¬ 
tions.  Underlying  these  partitioned  operations  is  the  partitioned  structure 
of  the  full  processor  error  estimation  model  into  D  and  R  module -related 
partitions.  This  structure  is  therefore  defined  in  detail  in  an  initial, 
separate  specification,  distinct  from  the  actual  module  specifications  that 
follow,  but  necessary  for  interpreting  them. 

An  understanding  of  the  intermodular  timing,  sequencing  and  data  flow 
is  an  equally  necessary  preliminary  and  reference  for  U3e  of  the  module 
specifications  themselves.  Another  initial,  separate  specification  which 
defines  these  interrelationships,  has  therefore  also  been  Included. 
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111.4.3 


KALMAN  FILTER  MODULES 
PARTITIONED  STRUCTURE 

SPECIFICATIONS  SUMMARY 
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This  specification  defines  the  D  and  R  module-related,  overall  Kalman 
Filter  structural  partitioning  by  means  of  an  ordered  set  of  tables  (Tables 
XXXII  through  XXXVII. 

In  particular,  the  initial  Table  XXXII  defines  the  multilevel  partitioning 
of  the  overall  processor  error  state,  from  the  two  broadest-level  partitions, 
which  model  to  the  processor  error  variables  associated  with  the  entire  D 
module,  and  the  entire  R  module  groups  respectively,  to  the  finest  level 
partitions,  each  of  which  models  the  error  variables  associated  with  only  a 
submodular  portion  of  just  one  of  the  D  or  R  modules.  Table  XXXIII  extends  this 
partitioning  beyond  the  error  state  vector  to  all  the  computational  entities 
processed  by  the  Kalman  modules,  at  the  broadest  D  and  R  group  level. 

Tables  XXXIV  through  XXXVI  then  define  the  finest  level,  singly  indexed 
partitioning  (principally  in  terms  of  non-null  partitions)  of  all  these  com¬ 
putational  entities,  for  the  D,  R  and  D/R  substates  respectively,  and 
Table  XXXVII  defines  the  doubly  indexed  (measurement -related)  partitioning  at 
this  level. 

It  is  important  to  note  that  these  tables  define  substate  reference 
frames,  dimensions,  indexing,  and  mnemonics  which  are  used  uniformly 
throughout  all  the  Kalman  modules. 
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TABLE  XXXII.  KF  NAVIGATION  ERROR  SUBSTATE  DEFINITIONS 


5  9 

* _ 

■o 

c 

~  g 

v  a. 


(*»3t jtqns  H)  •» j» jsqng 
JOJJ3  )U»iuajnit»H  ■'•N  J»M 


»J*5S  JOJJ3  uou»*TAtN  U*J»ao 
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Dimension  depends  on  equipment  t  ,  pes  and  KF  model  depth  required. 


(Unspc*:  if  led  Os  a  nd  Ks  depend  on  f)R  nav  equipment  types  and  on  depth  oi  KF  error  r,.odel  required) 


TABLE  XXXV.  R  SUBSTATE  VECTOR/MATRIX  STRUCTURE 


TABLE  XXXVII  D/R  MEASUREMENT-DIFFERENTIAL  VECTOR/MATRIX  STRUCTURE 


1 

l 

l 

L 

l  III ,4.b 

j  KALMAN  FILTER  MODULES 

TIMING  AND  SEQUENCING  ORGANIZATION 

[ 

L 

t 

L 

l 

[ 

i 

I 

1 

[ 

( 

f 
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This  specification  defines  the  relative  intermodular  timing,  sequencing, 
and  data  flow  for  all  Kalman  filter  modules,  within  a  single,  standard  (i.e., 
all -operations) ,  current  (nth),  Kalman  filter  execution  cycle. 

The  summary  diagram  (Figure  19)  divides  overall  single-cycle 
filter  operations  into  two  more  or  less  parallel  processing  areas.  The 
first  of  these  sequentially  involves  (a)  KTUM  prediction  of  the  processor 
error  estimate  and  covariance  matrix  across  the  prior  cycle,  using  predic¬ 
tion  matrices  generated  by  the  KT1M  in  the  prior  cycle;  (b)  KMRM,  KMCM,  and 
KMOM  preprocessing  of  raw  measurements  collected,  time-smoothed  and  syn¬ 
chronized  during  the  prior  cycle  by  the  KMMM  (and/or  R  modules)  for  current- 
cycle  use  by  the  KF1M;  (c)  actual  Kalman  filtering  by  the  KFIM  using  these 
preprocessed  measurements,  and  (d)  the  KCOM  generation,  and  end-of -current  - 
cycle  execution,  of  processor  module  (D,  R,  and  K)  control  corrections, 
based  on  the  updated  estimate  obtained  from  KFIM  filtering. 

The  second  of  these  parallel  processing  areas  Involves  (a)  KTMM 
generation  of  current-cycle  prediction  matrices  for  next-cycle  KTIM  use, 
and  (b)  KMiM  generation  of  current -cycle,  endpoint -synchronized  and  time- 
smoothed  measurements  and  measurement  matrices  for  use  by  the  measurement 
preprocessing  modules  (KMRM,  KMCM,  and  KMOM)  in  the  next  cycle. 

In  general,  the  overall  diagram  for  clarity  depicts  only  full-state 
operations;  however,  each  of  the  module  specif ications  themselves  in  fact 
defines  the  partitioned  equivalents  of  these  full-state  operations,  in 
terms  of  indexed  operations  on  the  D  and  R  substate  sets  (sd,  sd',  sri) ,  as 
defined  at  the  bottom  of  the  diagram. 

In  addition,  the  measurement  sets  remaining  after  successive  execution 
of  each  of  the  measurement  preprocessing  module  operations  are  also  sym¬ 
bolized  and  defined  at  the  bottom  of  the  diagram.  These  measurement  set 
symbols  are  used  in  defining  doubly  indexed  substate  processing  operations 
by  measurement  type  in  the  measurement  processing  (i.e.,  KFIM,  KMRM,  KMCM, 
KMOM,  and  KMtQ  modules. 
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KF  CYCLE 
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CONTROL 

MODULES 
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MEASUREMENT 
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MEASUREMENT 
SELECTION 
MODULES 


TIME 

UfDATE 

MATRIX 

GENERATION 

MODULE 


TIME 
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••I  a:  jrsmEnT 
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riRiirc-  19.  Kalrnn  Filter  Module,  Overall  Dynamic  Operations 
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III.4.C 

KALMAN  FILTER  ESTIMATE /COVARIANCE  MATRIX 
TIME  UPDATE  MODULE 

(KTUM) 

SPECIFICATION 


( 

l 


I 

( 

I 

t 

I 
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This  module  time»updates  the  KF  error  state  estimate  vector  and  its 
associated  covariance  matrix,  across  the  prior  cycle  to  the  beginning  of  the 
current  cycle  (time  tg)  ,  using  the  time  update  matrices  generated  by  the 

KTMM  in  the  prior  cycle. 
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TABLE  XXXIX.  KTUM  INPUT /OUTPUT  SUMMARY 


Input/Output  requirements 


III.A.d 


KALMAN  FILTER  MEASUREMENT  PREPROCESSING  MODULES 

(1)  MEASUREMENT  REASONABLENESS  TESTING  (KMRM) 

(2)  MEASUREMENT  OPTIMAL  SELECTION  (KMOM) 

(3)  MEASUREMENT  COMBINATION  (KMCM) 


SPECIFICATIONS 


These  modules  respectively  reasonableness-edit  (KMRM) ,  combine  (KMCM)  , 
and  order  (KMOM)  the  time -smoothed,  endpoint -synchronized  measurements  from 
last-cycle  KFWM  (and  R  module)  operations,  in  preparation  for  their  use  by 
the  KFIM  module  <n  the  current  cycle. 

In  particular,  it  should  be  noted  that  the  KMCM  (measurement  combination 
module)  specification  given  here  (and  the  related  KF  measurement  type 
definitions  of  subsection  III, 4. a),  explicitly  accommodate  only  linear  com¬ 
binations  of  measurements  of  different  types,  and  not  the  special  start-up, 
nonlinear  LOS  measurement  combination  technique  presented  and  discussed  in 
detail  elsewhere  in  this  document  (see  subsection  III.g.3  and  Appendix  IX). 

Although  it  appears  that  this  specification  could  be  4uite  simply  modi¬ 
fied  to  include  this  capability  as  well,  this  has  not  been  done  since  it  is 
felt  that  this  promising  technique  merits  a  further,  well-rounded,  overall 
investigation  of  its  own  --  one  which  would  in  particular  include  a  deeper 
examination  of  its  important  statistical,  geometrical,  time -sequencing,  and 
equipment -requirement  aspects. 

Finally,  it  should  be  noted  that  the  KMMM  specification  here  (in  con¬ 
junction  with  the  measurement  type  definitions  of  subsection  III. 4. a) 
implies  that  the  operations  of  raw  measurement  D/R  differencing,  KF  endpoint 
synchronization,  and  time  smoothing  must  be  done  collectively  within  the 
context  of  Kalman  operations  --  i.e.,  under  Kalman  timing  control.  However, 
these  operations  could  alternatively  --  and  perhaps  preferably  --  be  placed 
in  the  context  of,  and  within  the  timing  control  of  only  the  pertinent  R 
modules  instead.  As  a  third  alternative  in  certain  circumstances  (e.g.,  an 
R  measurement  which  is  available  at  a  very  high  rate)  they  could  perhaps 
best  be  placed  under  D  module  timing  control.  Which  of  these  options  is 
preferable  in  programming  for  a  specific  application  will  depend  in  general 
on  factors  peculiar  to  that  replication.  To  cover  the  two  most  likely 
possibilities,  these  operations  have  therefore  in  fact  been  specified  in 
two  places  —  i.e.,  in  both  the  K  and  the  R  module  groups  --  in  this  document. 
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Figure  20.  KMRM,  KMCM,  KMOM  and  KFIM  Submodule  Logic/Data  Flow 


TABLE  XL.  KMRM  OPERATIONS  SUMMARY 


'"'‘--^Substate 
s  s 

Operation 

Input  Measurement 

Type  Index  Setup 

u 

Substate 

Index 

a 

Setup 

41  B 
*-t 

O  41 

Unbiased 

Measurement 

*  c 

Computation 

U  Q) 

gj 

Measurement 

u 

Residual 

O  09 

Variance 

o  V 

Computation 

c 

O  tJ 
—■  41 

Averaged 

u  M 

Measurement 

o  U 

Reasonableness 

£4 

Test 

D  Substates 


R  Substates 


D/R  Substates 


s,s'  ■  sd* 
(sd*  DR  Mode 
Dependent) 


(AYm  )  5  (Wsjm  (Measurement  m  is  reasonable) 

"  >  "  (Measurement  m  is  jiot  reasonable) 


*Same  Equations  as  for  Estimate/Covariance  Matrix  Filtering  Submodule. 


TABLE  XLI.  KMCM  OPERATION  SUMMARY 


Substate 
Equat  iotT^^^Clasa 

D  Substates 

_ 

R  Substates 

D/R  Substates 

Execution  Once  per  KF 
Cycle  per  Averaged  Com¬ 
bined  Measurement  Type  m3 

Input  Measure¬ 
ment  Type 

Index  Setup 

m  »  m3 

Trace 

Computat ions 

TRm  -  Tr.ce  of  (All  m> 

Opt imum 
Measurement 
Id.'ntif  ication 

Find  m  such  that  TR  »  MAX  (All  m) 

(Q 

If  only  the  1*  (position  and  velocity  error)  partition  of  are  non-null 

(which  will  often  be  the  case),  then  the  trace  computation  algorithm  above 
reduces  to: 

TR^  TRACE  OP  (W^Dl*  l’«W) 
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TABLE  XLII.  KMCM  OPERATIONS  SUMMARY 


♦Depends  on  Candidate  Measurement  Combination  Algorithm 
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TABLE  XLIII .  KKRM  INPUT /OUTPUT  SUMMARY 


TABLE  XLIV.  KMOM  INPOT /OUTPUT  SUMMARY 


^'s'\NSubstate 

r  /s>>^Class 
Inputs/ 

Outputs 

D  Substates  Only 

Inputs 

KOPT*  APDm 

Outputs 

TR  ,  (TR  \ 
m  '  m/max 
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111.4.6 


KALMAN  FILTER  ESTIMATE /COVARIANCE  MATRIX 
FILTERING  UPDATE  MODULE 

(KFIM) 

SPECIFICATION 


159 


I 


This  module  summarizes  the  operations  which  comprise  actual  Kalman 
filtering  of  the  preprocessed  and  preselected  measurements;  i.e.,  the 
generation  of  a  new,  overall  processor  error  estimate  (and  its  attendant 
covariance  matrix)  using  these  measurements  and  the  a  priori  estimate 
generated  by  the  KTUM  in  the  current  cycle.  Both  estimates  --  the  KTUM 
current  cycle  estimate  and  the  one  generated  by  this  module  in  the  current 
cycle  --  are  estimates  of  processor  error  state  at  time  t  of  the  current 
cycle,  but  the  latter,  measurement -improved  estimate  supersedes  and  replaces 
the  former. 
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TABLE  XL VI .  KFIM  OPERATIONS  SUMMARY 


Subit«tc 

7  Cliis 

Opart  t  Ion  ' — 

D  Subatataa 

R  Subatataa 

D/ft  Subatataa 

Execution  Once 
pet  KF  Cycle 

Input  Me**ur*n*nt 
Typ*  Indtx  S«tup 

m  •  ml  or  m2  or  ml* 

Subttate 

Indtx 

Setup 

a,*'  *  ad' 

(ad'  DR  Med* 
dependant) 

■ta'  »  arO 

a  •  ad’,  *’  •  arO 

Execution  once  per  XF  Cycle 
per  Averaged  Measurement 

Type  al  or  m2  or 

Maaaurement 

R*» Idual 

Variant* 

Computation. 

5D--S.(HDxPD..'fiDL') 

^(“dx-*WdL) 

5Rm-ff(SRuPR..'fiRl.') 

^S-^rx-^rL) 

^D/Rm’S*  (*DnaPD/R*a  ’^Rma  *) 

VWSm**D/lte 

Nonrtcuralve 

Laaat  Square* 

Wtlght Ing 

Scalar 

Computation 

Smif’Sm.^a) 

^RM'?(7R«a*Vraa) 

Unblaaad 
Maaauramnr.t  - 
Residual 

Computat Ion 

(XD.+UD.) 

bDrat%t  ‘^Dm* 

7Rm“7Am'*^j**Rm#  (xRa+uR.)] 

<-7Dm-7Rm 

8 

•id 

U 

S 

u 

« 

X 

V 

<• 

in 

Xi 

9 

M 

U 

« 

a 

« 

u 

8 

Partltlonad 

Kalman 

Cain* 

Computation 

^Dma^|PDaa,MDna'  ‘ZDaa) 

^R-a^Ra.'C')-^. 

^D/Rma^i^D/Rat  '^Rras ') 
^R/Dma'®(PD/R**  ’^Draa ') 

bKDu”  ^^ttna^D/Rma) 

Partltlonad 
Nonracura  tve 

Laaat  Squar* 

Gtlna  Comp'n 

b  .  1  5  1 

'.Dma  JI  ora* 
n 

b  .  is  T 

LRma  M„,  R">» 

Part  It lonad 

Ovarall 

Ctlna 

Computation 

Ab  •  b  -b 

Dm$  K&M  t&M 

Ab.  •  b  -b 

Kite*  Lite* 

b_  •  b___  *  C  Ab_ 

Du  KDma  Dma 

bRMa  *  bKJte»*  ^bRma 

Eatlxt* 

Subatataa 

Maaauramant 

Update  Comp'n 

*D»**Da+t>Daa^7n 

*R.-XR*+bRuS7» 

u 

£ 

u  m  8 

Mi 

Hs 

O  M  M 

Covariance 

Submatr  lcaa 

Maaauramant 

Update 

Computation 

6PDu*'  ^a(bKDxb|tD*a ' 

-CPAb  Ab  T 
v  0  Dm*  Dm*'/ 

^PD/Rm*a ' "^m(bKftiubKDm* 1 

•C2Ab  A  b_T  ,) 

Dma  Rma  / 

PR*a 1  "PRaa  ’  *APRx» 1 

** 

PI>/M • ’ "PD/Rm  *  ‘*PD/ Rm» t  ‘ 

•Depend tng  on  how  axich  Intermediate  procaaalng  of  th«  tlx  averaged  xaauraxnt  iot  *1  u  don*  prior 
to  It*  u«*  by  thl*  eubmodula  (•••  Tlx  Averaged  H***ur*xnt  S*l*ctlon  *nd  linear  Cxbln*tlon 
eubmodula*  apaclf  Icttlom) . 


**Wh*n  ADR  p«*udo»t*t*  DA 2  1*  c«rrl*d  In  Xp,  Pp,  and  Pp^,  that*  op*r*tlon*  muat  b*  followed  by 
»*tt Ing  XpZ>  PD2$.  *nd  accordance  with  th*  formula*  footnoting  th«  operation*  aunaury 

for  th*  E*tlMt«/Cov*rl*ncc  Matrix  Tlx  Update  tubaodule. 

60989 
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*0r  m2  or  m3 


III. 4. £ 


KALMAN  FILTER  ESTIMATE /PROCESSOR  CONTROL  MODULE 


(KCOM) 


SPECIFICATION 


This  module  first  computes  controls  to  be  applied  to  processor  variables 
associated  with  both  non-Kalman  (D  and  R)  and  Kalman  modules,  and  then  applies 
not  only  these,  but  a  portion  of  the  corresponding  controls  computed  by  this 
(KCOM)  module  in  the  last  cycle. 

In  order  to  compute  the  non-Kalman  module  controls  for  application  at 
the  end  of  the  current  cycle  (i.e.,  at  time  t^,)  ,  the  current  KF  error  estimate 

(i.e.,  the  estimate  just  generated  by  current-cycle  KFIM  operations,  which 
relates  to  processor  error  state  at  time  tg)  is  first  predicted  across  the 

current  cycle  to  time  t^,.*  Two  types  of  KF  estimate  control  —  impulsive  and 

metered  —  are  then  computed  based  on  this  t  estimate,  which  can  then  be 

f 

discarded.  These  estimate  controls  are  then  used  to  compute  impulsive  and 
metered  control  for  the  non-KF  module  variables  which  are  then  applied  at 
time  tp. 

On  the  other  hand,  the  tg  estimate  is  retained,  and  is  corrected  for 

the  non-KF  module  impulsive  control  applied  at  the  end  of  the  last  cycle  by 
this  module  (KCOM)  by  subtracting  out  the  impulsive  estimate  control 
generated  by  this  module  in  the  last  cycle.  The  corrected,  retained  t 

b 

estimate  thus  corresponds  to  the  processor  error  state  at  the  beginning  of 
the  current  cycle.** 


*This  is  in  fact  a  pure  prediction  based  on  at  most  the  stationary  and 
quasi -stationary  portions  of  the  time  update  matrices,  since  the  non¬ 
stationary,  vehicle-dynamics -dependent  portions  will  not  be  available 
until  Mon  of  the  (parallel)  current-cycle  KTMM  operations. 

**This  estimate  thus  lags  real  time  by  one  cycle,  but  includes  all  vehicle- 
dynamics  -dependent  error  effects. 
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Execute  Once  per  KF  Cyfcle _ 

Estimate  Sync  (Prediction 

Estimate  Control  Across  Current  Cycle) 


TABLE  XL VIII .  KCOM  OPERATIONS  SUMMARY  (KF  CONTROL) 


**For  ADR,  additional  DA2  psaudostate  only)  updating  required  per  the 


footnote  in  the  operations  summary  for  the  eat iaate/covar lance  matrix 
time  update  submodule. 


I 

{» 


I  ' 


j 

I 
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40990 


TABLE  XLIX.  KCOM  OPERATIONS  SUMMARY  (NON-KF  MODULES  CONTROL) 


Input/output  .Requirements  for  ADR  Only 
ics-dependent  j.  and  G  Submatrices  Null 


INPUT/OUTPUT  SttttARY  (NON-KF  MODULES  CONTROL) 
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1 

1 


(vu\  ¥+TBD(A) 


Ill .4.g 

KALMAN  FILTER  TIME  UPDATE 
MATRIX  GENERATION  MODULE 

(KTMM) 

SPECIFICATION 
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This  module  generates  the  time  update  matrices  for  use  by  the  KTUM  on 
the  next  cycle.  The  algorithms  are  shown  in  their  fundamental  differential 
equation  form,  since  either  recursive,  or  single-pass  closed  form,  or  a 
mixture  of  both  of  these  types  of  solution  may  be  required  and/or  desirable, 
depending  on  the  nature  of  the  application. 
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TABLE  LII.  D  SUBSTATES  KTW  OPERATIONS  SUMMARY 
(GOVERNING  DIFFERENTIAL  EQUATIONS) 


I 
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s 
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Execution 


TABLE  LIII.  R  SUBSTATES  KDM  OPERATIONS  SIMiARY 
(GOVERNING  DIFFERENTIAL  EQUATIONS) 


Operat ion 

R  Substate 

Index  Setup 

s  ”  sro 

V  <-> 
PU  U 

«  u 
y 

ss 


R  Substate 
Prediction 
Submatrices 
Initialisation 


*Rs  ’  1 

■r.  "° 


*c 

o 


3 

y 

w 

x 

w 


R 

Substate 

Prediction 

Submatrices 

Generation 


Principal 
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Sub- 

matrices 


^Rs  *  ARs  *Rs 
\s  *  ^s 
+ARsRRs+(AR8RRs^ 


Other 

Sub- 

matrices 


*EMCution: 

•  Once  per  KF  cycle  if  A. 
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fv lf 

At 


R8 
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TABLE  LIV.  KTMM  INPUT /OUTPUT  SUMMARY 


Substate 
Inputs Class 
Outputs 

D  Substates 

R  Substates 

s  =  sd ' 

s  =  sro 

Inputs 

(AUss'’  KDs)i,n 

(A  ,  K_  )  . 

Rs*  Rs  i,n 

s  =  sd ' 

s  =  sro 

Outputs 

(<^Dss'’GDss'  ,RDss'\F,S)n 

(<^Rs’RRsV,S)n 

(^Dss',GDss',RDss,)i,n 

^Rs’Vi.n 

1 


5 


III.A.h 


KALMAN  FILTER  MEASUREMENT 
MATRIX  GENERATION  MODULE 

(KMMM) 

SPECIFICATION 


i 

i 

6 


177 


This  module  KF  endpoint 'Synchronizes  and  time-smooths  currcuc -cycle  raw 
D/R  synchronous  measurement -differences  and  their  associated  measurement 
matrices.  Its  outputs  are  further  processed  by  the  measurement  preprocessing 
matrices  (KMRM,  KMCM,  KMOM)  in  the  next  KF  cycle.  The  algorithms  are  shown 
in  their  fundamental,  nonrecursive  summation  forms.  Compact  closed-form,  or 
recursive,  or  a  mixture  of  both  types  (all  based  on  these  fundamental  forms) 
may  be  required  and/or  desirable,  depending  on  the  nature  of  the  application. 


* 
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TABLE  LV.  KMMM  OPERATIONS  SUMMARY 


1J*  «  Larger  of  1  and  J. 

**0»lttad  hara  tor  lack  ot  apaca.  Saa  AppandU  VIII 


179 


III.  5 


INITIALIZATION  AND  SWITCHING  MODULES 
SPECIFICATIONS 


181 


These  modules  together  comprise  the  operations  necessary  to  initiate 
and  subsequently  to  switch  processor  navigation  with  regard  to  DR  mode, 

R  configuration,  and  computational  reference  (C)  frame. 


III. 5. a 

NAVIGATION  START “UP  MODULE 
(NSTM) 

SPECIFICATION 


183 


This  module  initializes  processor  dynamic  operation  before  first  entry 
to  the  main,  dynamic  navigation  loop  for  PDR  operation. 

Specifically,  it  initializes  (a)  the  computational  frame  (to  C  =  E)  ; 
(b)  initial  position,  velocity,  and  pseudo-acceleration  to  null  vectors; 
and  (c)  the  KF  PDR  error  substate  and  control  vectors  to  null,  and  the 
covariance  matrix  to  large  values  to  reflect  the  consequent  large  uncorre¬ 
lated  uncertainties  in  the  initial  position,  velocity  and  the  pseudo¬ 
acceleration  error  substates. 
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I 

l 


! 


Execution  Prior  to  Dynamic  Nav  Loop  Entry* 


TABLE  LVII.  NSTM  OPERATIONS  SUMMARY 


start  Type 


Operat ion 


C  Frame 
Initialization 
(C  =  E) 


Fixed  Start 


°-  tc/d  -  1 


Moving  Start 


VSTM 

Initialization 
(for  PDR  Start) 


p  ■  0 

v  ■  0 


/9l  -  o 


v  ■  0  "  Constant 


s.s’  -  DP1-DP3 


XD.'  0 

v° 

KFM/DR  .  .  „ 

Initialization  us 
(for  PDR  Start) 


PDbb'*  0 

'is.’-om1  <■  ‘  DP1> 


o-Q*  y  R0;R0“  nom-  earth 
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s-DP2 

'dbs^vO1  *W  U 

1 VCR  i  ’ 

IvIcr" 

nom. 
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cruise  speed) 

S-DP3 

P  - 
Dss 

~2  „ 
°ei  0 

0 

n  2 

0  rfi2 

0 

0  0 

2 

fill 

♦Execute  Operations  in  Order  Shown 


III.5.b 


C  FRAME  SWITCHING  MODULE  (IyON-KF  MODULES) 
(CSWM) 

SPECIFICATION 
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This  module  embeds  the  operations  necessary  to  (a)  define  a  new  compu¬ 
tational  reference  frame,  (b)  generate  the  switching  transformation  and 
center -displacement  vector  between  the  old  and  new  computational  frames, 
and  then  (c)  switch  all  affected  processor  D  and  R  variables  to  the  new 
frame.  Actual  switching  of  the  variables  is  delayed  until  the  end  of  the 
KF  cycle  in  which  the  new  C  frame  comnand  was  initiated,  at  which  time  af¬ 
fected  K  module  variables  are  also  switched  by  (a  submodule  of)  the  KSWM. 
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Figure  23.  CSWM  Operations  Flow  (Non~KF  Modules) 


nth  K F  Cycle  Endpoint  Execution* 


TABLE  LIX.  CSWM  OPERATIONS  SUMMARY  (NON'KF  MODULES) 


*Haw  C  frane  eonnended  by  operator  In  nth  KF  cycle.  40994 


II1.5.C 


COARSE  ALIGN  MODULE 
(CALM) 

SPECIFICATION 
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This  module  la  used  to  accomplish  coarse  (DflJ  or  AHRU)  platform-to- 
computer  alignment  prior  to  IOR  or  ADR  operation. 

In  particular,  initial  IHU  operations  consist  of  coarse-level lng  the 
platform  (if  it  is  of  the  rotatlonally  isolated  type).  When  this  is  com¬ 
plete,  no  further  operations  are  initiated  unless  VSTM  position  and  velocity 
data  is  sufficiently  accurate  (as  indicated  by  the  corresponding  KF 
variances).  When  this  latter  condition  is  met,  coarse  computational  align¬ 
ment  ••  i.e.,  coarse  determination  of  the  (AHRU  or  IMU)  platform-to-computer 
and  L-frame-to-computer  transformations  for  subsequent  PLAM  IDR  or  ADR 
navigation  updating  «-  begins  and  continues  until  the  initiation  of  the  IDR 
or  ADR  navigation. 
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ACC  *™|l>  COUID  ALSO  Bt  A  lIMt  TfSI.  ANO  fllHCB  TfST  COUiD  U 

C  .'fMlDOtN  BY  DtftfCT  OPESATOB  MODt  CONTKOl. 


Alignaant  Phaa.  tract  ion  Phaa  a 


TABLE  LXI.  CALM  OPERATIONS  SUMli.O 
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DR  NAV  MODE  SWITCHING  MODULE 
(DSWM) 


SPECIFICATION 


This  module  («)  selects  the  appropriate  (i.e.f  highest-level)  DR  mode 
of  operation  based  on  current  DR  equipment  navigation  output  data  availability, 
(b)  sets  the  corresponding  DR  navigation  mode  marker  (DRMM)  which  controls 
the  DR  configuration  of  the  D  modules  and  the  CSWM  (and  is  also  used  by  the 
KSWM) ,  and  (c)  if  the  mode  is  a  new  one,  executes  the  required  set-up  for 
that  mode. 

In  particular,  if  th?  new  mode  selected  Involves  a  platform,  PDR 
operation  is  continued  until  CAIX-controlled  coarse  alignment  is  complete. 

Also,  the  additional  new-sode  set-up  specified  is  minimal  because,  and 
only  if,  the  first  new-mode  cycle  execution  order  of  each  of  the  D  modules 
is  that  shown  in  the  operations  summary  table  for  that  module. 
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Plgure  25.  Overall  DSWM  Organizatlon/Loglc/Data  Flow 
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FIGURE  -  7  OR  NAV  MODE  SWITCHING  REQUIREMENTS  SUMMARY 
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jf/MARY 


(J)  This  table  assumes  all  CAIJ1(AD5tj  equations  DRMM  -  DR  Nav  Mode  Mark  (b)  Except  PLAM  variables 

are  executed  in  a  single  fast  loop  (MO DM)  -  =  So  Action  Requr.  T  .  ,T  ,  ,T 

cycle,  just  folltMiag  DSUH  execution  on  that  ?/Z'  P/L’  L/C 

tyt|e-  (initialized  by  CALM) 


REFERENCE  NAVIGATION  MEASUREMENT 
SWITCHING  MODULE 

(RSWM) 


SPECIFICATION 


This  module  comprises  the  operations  necessary  to  switch  processor  opera¬ 
tion  from  one  reference  navigation -measurement  availability/use  configuration 
to  another  such  configuration,  in  the  event  of  new  measurement  availability  or 
old  measurement  drop-out. 

Separate  submodules  are  included  for  switching  of  (a)  the  TDPM  emitter 
range/range-rate  measurement  configuration,  and  (b)  the  reference  altitude 
measurement  (ALTM)  mode  of  operation. 

In  particular,  the  TDPM  switching  is  organized  first  on  a  general,  overall 
emit ter -net  basis,  and  then  into  a  more  detailed  per -emit ter  basis.  Markers 
are  generated  for  each  emitter  which  control  the  switching  and  subsequent 
operation  of  not  only  the  TDPM  modules  themselves,  but  their  associated  KF 
error  substates  as  well  (via  the  KSWM) . 

The  ALTM  switching  sets  a  single  marker  to  corresponding  control  switching 
and  subsequent  operation  of  the  ALTM  and  its  attendant  KF  error  substate. 
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Figure  28.  Overall  RSWM  Organization/Logic/Data  Flow 
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KALMAN  FILTER  CONFIGURATION  SWITCHING*  MODULE 


(KSWM) 

SPECIFICATION 


*Navlgation  configuration  and  C  Franc  switching 


This  nodule,  using  the  DR  navigstion  mode  and  reference  navigation  con¬ 
figuration  markers  as  inputs,  controls  the  operation  and  switching  of  KF 
substates  so  as  to  correspond  to  and  synchronize  with  the  operation  and 
switching  of  the  D  and  R  modules. 

To  facilitate  this,  modules  are  grouped  into  (a)  those  dealing  with 
current-cycle  data  (KTMM,  Klftl) ,  (b)  those  dealing  with  last-cycle  data 
(KTUM,  KFIM,  KMRM,  KMCM,  and  KMOM)  ,  and  (c)  those  dealing  with  data  from 
both  cycles  (KCOM) .  For  each  cf  these  modules,  both  a  standard  operation 
(i.e.,  operation  according  to  the  MLI  module  specification),  and  a  non¬ 
standard  operation  (i.e.,  slightly  modified  operation,  or  complete  bypass) 
is  defined.  Standard  or  nonstandard  cur rent -cycle  and  next -cycle  operation, 
and  appropriate  KF  substate  switching,  are  then  prescribed  as  a  function  of 
all  possible  combinations  of  D  mode,  R  configuration,  or  C  frame  changes 
(or  none  at  all)  in  the  last  and  current  KF  cycles. 

In  particular,  the  substate  switching  requirements  are  simplified  by 
defining  them  in  terms  of  requirements  on  three  D-substate,  and  three 
R-substate,  logical  sets;  i.e.,  all  those  substates  common  to  the  pre-  and 
post-switch  (D  or  R)  configurations,  and  all  those  associated  with  only  the 
old,  or  only  the  new,  configurations. 

The  rationale  underlying  KF  module  operation  (standard,  nonstandard,  or 
bypass)  during  processor  configuration  switching  rests  simply  on  the  desire 
to  maintain  the  KF  estimate  current  through  such  periods.  Since  switching 
operations  take  time,  and  estimator  currency  resides  in  the  KTMM  and  KTUM 
module  operations,  operations  of  all  other  modules  are  reduced  or  bypassed 
to  allow  sufficient  time  for  intermodal  switching,  and  intramodal  execution, 
of  these  modules  at  a  sufficiently  high  rate. 


TABLE  LXVI.  SUMMARY  OF  nth-CYCLE  NAV  CONFIGURATION  SWITCHING  MODIFICATIONS  TO  STANDARD  KTMM  OPERATIONS 
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TABLE  LXVXI .  SUMMARY  OF  nth  CYCLE  NAV  CONFIGURATION  SWITCHING  MODIFICATIONS 
TO  STANDARD  KTAM  AND  KFIM  OPERATIONS 


A.  KTMM  MODIFICATIONS 

Substate 

„  .  .  *  *— —  Class 

Operations 

D  Substates 

R  Substates 

Execute  Once  at  Each 
Current  Cycle  Change  of: 

DR  Nav 
Mode 

Standard 

Operations 

Bypass 

•  Completely  bypass  all  further  current 
cycle  KTMM  operations. 

Ref  Nav  Conf. 

TSMM  Set* 
Generation 

Mod if icat ions 

•  Discontinue  further  generation  of  all 

TSMM  sets  involving  PRER  substates. 

•  Initiate  postswitch  generation  of  all 

TSlfl  sets  involving  POSTR  substates. 

•  (Continue  uninterrupted  generation  of  all 

TSMM  sets  involving  only  COMR  substates) 

B.  KFIMs  MODIFICATIONS 

Substate 

Operat  ion  '**  - — 

D  Substates 

R  Substates 

Execute  Once  in 
Current  KF  Cycle 
if  in  last  KF 
Cycle: 

DR  Nav 

Mode 

Change 

Standard 

Operations 

Bypass 

»  Completely  bypass  all  current  cycle 

KFIM  operations 

R  Nav 
Conf. 
Change 

TSMM  Set 

The  Med  if  i- 
cat ions 

•  Omit  processing  of  all  TSMM  sets*  whose 

last-cycle  KMMM  generation  was  discontinued. 

*Time  Synchronized  Measurement  Matrix  Set:  (Y  ,AY  ,C  ,M  ,N  ,Z  ,W  . 

m’  m’  m  ms  ms’  ms  ms) 
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TABLE  LXIX.  SUMMARY  OF  KF  DR  NAV  SUBSTATE  SWITCHING  SETS 


From  DR  Nav  Mode 

IDR 

PDR 

ADR(DG) 

ADR (MAG) 

Com;  DIl-7 

DI1,2-DP1,2 

DI1,2-DA1,2 

Dll , 2=DA1 , 2 

IDR 

Pre:  " 

DP3 

DA3-7 

DA3-7 

Post:  " 

DI3-7 

DI3-7 

DI3-7 

DPI, 2=01 1,2 

DPl-3 

DPI, 2 -DAI, 2 

DPI , 2-DAl , 2 

<u 

*o 

o 

PDR 

DI3-7 

II 

DA3-7 

DA3-7 

X 

> 

DP  3 

II 

DP3 

DP3 

cO 

SB 

OC 

/-S 

« 

DAI, 2-011,2 

DAI ,  2=*DP1 , 2 

DAI -7 

DAI-7 

a 

o 

fit! 

DI3-7 

DP3 

It 

If 

H 

< 

DA3-7 

DA3-7 

II 

II 

o 

DA1,2*DI1,2 

DA1,2«DP1,2 

DAW 

DAI -7 

t 

DI3-7 

DP3 

II 

II 

as 

a 

< 

DA3-7 

DA3-7 

II 

»• 

Note:  New  mode  substate  initialization  requirements: 

•  New  common  substates  ■  old  common  substates 

•  Post  substates  -  stored  constants 

Pre,  Post,  Com  -  Preswitch-only,  postswitch-only,  preswitch- 
postswltch-common  substate  sets 
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TABLE  LXX.  SUMMARY  OF  KF  REF  ALTITUDE  SUBSTATE  SWITCHING  SETS 


From  Ref  Altitude  Mode 

APS 

AB 

GFB  GF 

To  Ref  Alt  Mode 

APS 

COM  Ah 

P 

PRE  " 

POST  " 

8hB 

V 

•k 

6hP 

6h 

P 

AB 

6hB 

6hB 

It 

II 

6hB 

GFB 

6hP 

1  1  1  f 

1  1  1 

i  i  a 

■  a  a 

GF 

♦Initialize  According  to  Ah  ■  Ah_ 

P  B 

♦♦Assumes  candidate  KF  ref  alt  error  substate 
composition: 


*RUA 


'6hB 

Ah 

P 


Barometric  Altitude  Error 
Pseudo-Altitude  Error 


Note:  New  mode  substate  initialization  requirements: 

•  New  common  substates  -  old  common  substates 

•  Post  substates  *  stored  constants 

Pre,  Post,  Com  ■  Preswitch-only,  postswitch-only, 

presw itch-post  switch-common  substate 


♦Applies  to  reference  altitude  measurements  as  well  as  njth  emitter  measu 
**If  KF  modelling  of  njth  signal  error  is  to  be  omitted  (to  make  room  for  a 
signal  substate),  this  logical  output  marker  state  should  be  artificially 
to  preswitch-only  instead,  to  enable  its  subsequent  omission. 


TABLE  LXXII .  c  FRAME  SWITCHING  OPERATIONS  SUMMARY  (KF  MODULES) 
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**A11  REnE  assumed  here  to  be  composed  of  both  position  and  velocity  error  substates. 
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This  module  reads  1  in  all  constants  necessary  to  overall  processor  modular 
operations.  Many  of  these  constants  are  navigation  equipment -related  (they 
correspond  to  and  are  needed  for  characterisation  and  correction  of  the  navi¬ 
gation  sensor  equipment  complement  used) ,  while  the  remainder  are  required 
whatever  the  equipment  complement  employed.  These  requirements  are  broadly 
summarized  for  each  processor  module  in  the  tables  included  in  this  specifica¬ 
tion. 


No  attempt  is  made  here  to  define  either  the  associated  input  data  con¬ 
stant  verification  operations  or  their  attendant  control/display  panel  inter¬ 
facing  operations,  since  these  are  outside  the  scope  of  the  processor 
developed  to  date. 
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•  Wind  model 


TABLE  LXXIV.  R  MODULE  CONSTANTS  REQUI 
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SECTION  IV 

HOL  PROCESSOR  (LIMITED  MLI  PROCESSOR  VERSION) 


This  final  main  section  presents  and  discusses  a  specialized,  functionally 
limited,  FORTRAN  IV/IBM  370  programmed  version  of  the  MLI  processor,  as  far 
as  it  has  been  developed  to  date. 

The  purposes  of  this  development  were  two-fold.  Both  have  been  fulfilled. 
These  were  (a)  to  provide  a  first-time  vehicle  for  MLI-based  programming  of  a 
specific  processor  application  in  a  specific  language  for  a  specific  machine, 
and  (b)  to  provide  a  program  nucleus  which  could  eventually  be  easily  developed 
into  either  a  processor  algorithm  evaluation,  a  simulation  program,  or  a  master, 
HOL  navigation  processor  software  generation  program. 

In  order  to  permit  a  meaningful  level  of  development  of  an  HOL  (FORTRAN  IV) 
processor  program  toward  these  ends  within  the  time  and  funding  available  In 
Phase  II,  a  set  of  simplifying  and  facilitating  guidelines  and  assumptions  was 
therefore  formulated  prior  to  initiation  of  the  actual  programming  effort. 

These  guidelines  and  assumptions  were  then  carefully  adhered  to  during  the 
development  itself. 

In  this  connection,  a  loose  scenario  for  a  multiphase  tactical  mission 
was  first  formulated.  This  scenario  was  chosen  especially  to  enable  (or  even 
require)  exercising  many  of  the  MLI  processor  functional  capabilities,  includ¬ 
ing  most  of  those  of  special  interest  and  importance  (e.g.,  C-frame  switching, 
simultaneous,  dual-LOS-net  pseudorange  processing,  etc.).  Next,  a  candidate 
navigation  processing  design  was  formulated  --  with  particular  attention  to 
minimizing  the  required  Kalman  filter  state  vector  size  --  tc  accomplish  this 
mission.  This  design,  together  with  the  mission  scenario  to  which  it  applies, 
is  summarized  in  paragraph  l.a  in  terras  of  the  navigation/environment  equip¬ 
ment  assumptions,  and  in  Table  LXXVTI  in  terms  of  candidate  processor  config¬ 
uration  by  mission  phase. 

This  scenario/candidate  processing  design  then  furnished  the  basis  for 
identifying  the  appropriate  subset  of  the  general  (Section  III)  MLI  specifi¬ 
cations  necessary  to  implement  it.  To  further  delimit  the  required  programming 
effort  to  the  time  'nd  funding  available,  a  set  of  additional  simplification 
constraints,  which  are  summarized  in  paragraph  l.b,  was  invoked.  These  were 
selected  specifically  to  have  minimal  effect  on  program  capabilities  with 
respect  to  the  chosen  scenario  (e.g.,  omission  of  coarse  alignment  and  DR 
navigation  mode  switching  capability  did  not  reduce  the  capability  of  the 
program  to  conduct  all  significant  phases  of  the  mission  shown  in  Tabic  LXXVTI. 
The  residual  MLI  specifications  required  for  final  programming  are  summarized 
in  subsection  2. 
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TABLE  LXXVII .  CANDIDATE  NAV  PROCESSOR  CONFIGURATION  BY  MISSION  PHASE 


Use  of  this  framework  of  mission  and  hardware -related  ground  rules  and 
constraints  (as  summarized  in  Table  LXXVII  and  paragraphs  l.a  and  l.b)  ,  in 
part  created  for  the  analyst  and  programmer  involved  an  atmosphere  not  unlike 
that  surrounding  an  actual  software  development  for  a  specific,  real-time 
navigation  system  application.  This  was  valuable  as  a  test  of  the  usefulness 
of  the  MLI  specifications  in  situations  of  this  sort,  for  which  it  was  in 
large  part  designed. 

The  actual  HOL  program  developed  to  date  is  presented  in  subsection  3, 
in  terms  of  general  organization,  module  descriptions,  common  and  special 
subroutines,  an  input/output  and  level-of-checkout  discussion,  and  finally 
the  actual  FORTRAN  IV  program  listing  itself. 

1.  SPECIALIZING  ASSUMPTIONS  AND  CONSTRAINTS 

This  subsection  (and  Table  LXXVII)  summarize  the  assumptions  and  con¬ 
straints  which  simplified  and  facilitated  the  development  of  the  nucleus  program. 


Na\>ig3tion  Environment:/E<?nipment  Assumptions 

(1)  Navigation  Environment 

(a)  Tactical  aircraft 

(b)  Tactical  multiphase  mission 

•  Enroute  (NAVSAT/IMU) 

•  Local  area  approach  and  weapon  delivery 
(LOS  ground  net/lMU) 

•  Return  to  base  (NAVSAT/IMU) 

(2)  Navigation  Equipment 

(a)  Onboard  aircraft 

•  Digital  navigation  computer(s) 

•  IMU  (rotational ly  isolated) 

•  LOS  ground  net  receiver  equipment 
(single  channel,  high-accuracy  clock) 

•  NAVCAT  receiver  equipment 

(single  channel,  high-accuracy  clock) 

•  Barometric  altimeter 

(b)  External  to  aircraft 

•  LOS  ground  emitter  net  (4  emitters;  serial,  synchro¬ 
nized  transmissions;  accurate,  intra-net  emitter 
location  survey) 

•  NAVSAT  net  (4  emitters;  serial,  synchronized  trans¬ 
missions;  accurate  E  frame-referenced  ephemeris  data 
transmissions) 
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b.  Processor  Development  Level  Simplification  Constraints 


(1)  Basic  Navigation  Only 

(a)  Position/velocity  vector  outputs  only  (i.e.,  no  air¬ 
craft  attitude,  attitude  rate  outputs) 

(b)  No  coarse  alignment 

(c)  No  DR  navigation  mode  switching  (radio-inertial  only) 

(d)  No  intramission  reference  navigation  switching 

(2)  Simplest  Algorithm  Choice  (where  intramodular  choices  exist) 

(3)  Limited  Checkout  (in  absence  of  equipment/environment 
simulation) 

(4)  Geodetic  Assumptions:  Spherical,  homogeneous  earth 

2.  MLI-BASED  SPECIFICATION 

With  the  set  of  simplifying  ground  rules  just  defined,  the  relevant  sub¬ 
set  of  the  overall  MLI  specifications  of  Section  II  which  is  required  as  a 
basis  for  programming  can,  because  of  the  modular  organization  of  the  processor, 
be  quickly  identified. 

This  required  MLI  specification  subset  is  briefly  summarized  in  the 
following  paragraphs. 

a .  Processor  Module  Requirements 

(1)  Required  Modules 

(a)  Initialization/Switching:  CONM,  CSWM 

(b)  DR  Navigation:  PLAM,  VSTM 

(c)  Reference  Navigation:  ALTM,  TDPM  (TEWH,  TRRM,  TPCM, 

TMCM,  TMMM) 

(d)  Kalman:  KTUM,  KFIM,  KCOM,  KTMM,  KMMM 

(2)  Modules  Not  Required 

(a)  Initialization/Switching:  NSTM,  CAU1,  DSWM,  RSWM,  KSWM 

(b)  DR  Navigation:  WASH 

(c)  Reference  Navigation:  POSM  tTDPM  (TAAM,  TALMt  TDSM) 

(d)  Kalman:  KMRM,  KM CM,  KMOM 
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b.  Module  Algorithm  Requirements 


(1)  CONM:  Constants  appropriate  to  (F)IMU,  CADS(baro  altitude) 

ground  LOS  and  NAVSAT  signal  equipment  and  use  only, 
and  for  only  those  modules  specified  in  paragraph 
2.a(l)  above. 

(2)  CSWM* 

(a)  IDR  (without  TAS)  algorithms  only 

(b)  C  frame  definition  and  input  data** 

(3)  VSTM* 

(a)  IDR  algorithms  only 

(b)  gE>  pg  formulae** 

(A)  PLAM* 

(a)  IF  algorithms  only 

(b)  Omit  Aw,  Af ,  Af^  and  computations  entirely 

(c)  Omit  TA/p,  (U>A/p)p  computations  entirely 

(d)  formula 

(5)  ALTM* 

(6)  TDPM*:  G  and  S  configuration  algorithms  only,  pseudorange(no 

pseudorange  rate)  measurements  only. 


(a) 

TEWM: 

Operations  GAS(3)and  (4) only 

(b) 

TRRM: 

GS(1)  ,  GAS ( 1)  -  (3)  only 

(c) 

TPCM: 

GAS (2)  only 

(d) 

TMCM: 

GAS ( 1)  ,  (3),  (5)  and  (7)  only 

(e) 

TMMM: 

GAS(l),  (2)  and  (5)  only. 

*  See  Mil  module  specification. 

**See  the  special,  spherical  homogeneous  earth-based  formulae  which  are 
summarized  at  the  end  of  this  subsection. 
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(7)  Kalman  Filter  Partitioned  Structure* 

(a)  Error  Subatate  Definitions: 

•  D  Substates:  IDR  only;  Dll  through  DI4,  DI4**  of 
dimension  3 

e  R  Substates:  RUA  (dimension  1)**,  RUC  (user/emitter 
net  clock  phase  difference,  dimension  2),**  RE  (emitter 
net  datum  error,  dimension  3,  or  emitter  signal  propa¬ 
gation  delay  error,  dimension  1  per  emitter)** 


*  See  MLI  module  specification. 

**Possible  mis slon -phase -dependent  substates. 
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Np:  m  *  2: 

all  null;  m  =  3: 

DI3 

M^:  m  =  2: 

per  spec;  m  =  3: 

^UC*  ^RE** 

(8)  KF  Modules  Timing  and  Sequencing  Organization: 
per  specification 

(9)  KTUM 


(a) 

IDR  only 

(b) 

/Wc 

sd'  =  DI1+DI2  =  Dll',  DI3,  DI4 

(c) 

sro  =  RUA 

•ie  'if 

,RUC  ,RUE 

(10) 

KFIM 

(a) 

sd'  ,sro  as  above 

(b) 

** 

m  =  ml 

(set  of  all  sequential  time-point  measurements 
in  KF  cycle) 

(ID 

KCOM 

(a) 

IDR  (IF  only) 

(b) 

sd' ,sro  as  above 

(c) 

Non-KF  Modules  Control 

•  PLAM: 

Omi  t  Af,  andAu.  corrections 
k  k 

•  WASM: 

Omit 

•  ALTM: 

AB  algorithm  only 

•  TDPM: 

User/emitter  clock  correction  =  user  clock 
correction  shown;  emitter  net  datum  error  is 
ARe  "  A^e  -  emitter  propagation  error 

correction  is  A^L  ■  A^L  -  u^^  (per  emitter) 

(12) 

KTMM 

(a) 

IDR  only 

(b) 

sd' ,  sro 

as  above 

(c) 

D  Submatrix  Generation:  Execute  the  closed -form,  non¬ 
recursive  equations  shown  below,  once  per  KF  cycle  for 
KTUM  use,  and  once  per  measurement  availability  per  KF 
cycle  for  KMMM  use. 

*  Possible  mission-phase-dependent  substates 
**Mission-phase-dependent 
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(d)  R  Submatrix  Generation:  Execute  the  closed-form,  non¬ 
recursive  equations  shown  below,  once  per  KF  cycle  for 

KTUM  use  with  t  ■  t  -t_,  and  once  per  measurement  avail- 

F  b 

ability  per  KF  cycle  for  KMMM  use  with  t  *  t^-t^. 


KTUM  j 
Use  A 


*Dl'i'  "  1  +  ADC1'1'  At  +  2  (ADC1  ’1 '  At)2  (ADC1'1’  “  ADIl'l,! 


KMMM  J  *  ,  = 

Use  *  U1  J 


'D1'3 


g  At  +  AP 


■  vi At) 


x  T 


C/P 


(g  +  Av  j  x  T 


C/P 


(-igAt2)xT 


C/P 


flgAt2)xT 


C/P 


*D33  ‘  1  '  <ieE/I+ieP/C>P,‘ 
*M4  ’  1  At  (°r  0> 

*D44  ”  1  x  ADC44At 


G__,  -  I  At 
D33 


<A‘WP-TP/CUE/IAt 

(A0p/c)p  *  (wp/c)p 


see  MLI  D  Substate 

structure 

specifications) 


«  constant  diagonal  matrix 
d* 

i)33 

*1)44  = 

ADC44 


KTUM  Use 

KMMM  Use 

At 

t  -  t„ 

t,  " 

F  S 

i  F 

Av 

v„  -  v_ 

v.  -  v_ 

F  S 

i  F 

AP 

PF  ’  PS 

Pi  '  PF 

V, 

v_ 

v_ 

1 

S 

F 

g,  UE/I*  TP/C*  ^P/C2  any  values  in  currePt  KF  cycle 


♦Mission -phase-dependent 
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(13)  KMMM 

■JL 

(a)  m  *  ml  (see  above) 

(b)  n  =>  1  (KF  endpoint-synchronization  only;  no  time 

smoothing) 


(c)  sd ' ,  sro  as  above 


(d)  Measurement  Matrix  Generation  (m  =  2;  altitude):  Execute 
the  closed-form  equations  below  once  per  measurement 
availability  per  KF  cycle  (i.e.,  once  at  t  *  tp) : 


yr  ■  (Vf 


Cp  *  constant 


**D1'  *  “dI'F 

“  ^8T/|  8  |  0] 


AY 


Y  -  Y 
D  *R 


=  constant 


^RUA  =  HrUA 


=  -1 


(e)  Measurement  Matrix  Generation  (m  ■  3;  LOS  pseudorange): 
Execute  the  closed-form  equations  below  once  per  meas¬ 
urement  availability  per  KF  cycle  (i.e.,  once  per 
availability  of  emitter  )  at  time  t^'; : 


Dj 

s 

v< 

Vj3 

Vi  3 

V1 

rji 


Pji  "  CJi 


constant  j 


“cjl'i  ^Dl'l'i.F 
Vjl'i  ^Dl  *3i,F 
_MDjr  iGDl'3i,F 

•] 


PJi  ~  eJi 
PJi  '  Cj : 


Rj 


-R 


mj 


C  .  ■  constant 


^UC  "  ^UC  \uCi,F 
**REj  "  ^StEji  ^REji.F 


w 


-  C  0 1  (C  ■  velocity 
L  of  light) 


M^g.^  *  -r*  (LOS  net  datum 
J  error) 


Mggj  ■  -1  (NAVSAT  or  LOS  emitter 
propagation  error) 


AY  ■  Y  -  Y 

j  Dj  Rj 


*Mi ss ion -phase-dependent 
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(14)  Simplified  Formulae  (Based  on  homogeneous,  spherical  earth 
assumption) : 

(a)  Gravity 


gE^PE^ 

k  . 

o  |  I  2 

3  WE/I 

1  +  (UJE/I^E  ^E/I^E 

PE  J 

(if  |pe  |  <  RQ  -  AR,  take  g£  -  0 
2 

(k  *  G  R  ;  G  ,  R  ,  AR  are  scalar  constants) 

'  a  n  a  a  7  ' 


(b)  Subaircraft  Position  Vector 


(c)  Earth's  Geoidal  Curvature  Matrix 

0  ‘ 
-1 
0 


(d)  C  Frame  Definition 


Enroute;  C 


E,  so  that  Cc/E  -  0,  Tc/e 


I 


Objective  Area:  C  *  Tangent-plane,  Cartesian  frame 
centered  at  XcTR,  L^,  hCTR  (latitude,  longitude, 

altitude) ,  so  that: 


JC/E 


(Ro  +  W 


C11  ■* 


’12 


L  13  J 


C/E 


ij  3x3 


C11 

■  5l"  ACTR 

C  m 

C12 

COS  *CTR  cos  Lctr 

C13  ■  c°8  actr  8ln  lctr 

C21 

-  0 

c  ■ 

22 

•,In  actr 

c23  '  cos  LCTR 

C31 

'  cos  actr 

C  m 

c32 

-si"  Rctr  cos 

c33  '  •sln  ACTR  sln  lCTR 
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3.  FORTRAN  IV/IBM  370  PROGRAM  DESCRIPTION 


The  MLI  specification  approach  to  generating  digital  navigation  system 
software  does  in  fact  introduce  many  savings  in  programming,  in  checkout,  and 
in  changes  and  modifications  to  such  software.  This  conclusion  has  been 
reached  as  a  result  of  the  direct  (although  limited)  experience  gained  with 
the  technique  in  actually  programming  the  limited-version,  FORTRAN  IV/lBM  370 
program  presented  and  discussed  here.  The  validity  of  this  contention  will 
become  more  apparent  against  the  background  of  the  organizational  simplicity 
and  flexibility  which,  by  following  the  MLI  specification,  have  been  embedded 
in  this  sample  program. 

Before  proceeding  with  the  discussion,  it  is  first  emphasized  that  the 
program  developed  to  date  is  not  yet  either  usable  or  fully  checked  out. 

That  is,  because  no  dynamic,  mission-history  simulation  of  navigation  sensor 
input  data  and  vehicle  flight  profile  is  yet  available,  it  has  not  been  possible 
to  carry  checkout  past  a  relatively  rudimentary  level  (i.e.,  only  to  the  level 
of  separate  module  or  module  group  checkout  and  only  with  fixed  inputs) ,  let 
alone  to  exercise  the  overall  program  in  simulated  navigation.  Nevertheless, 
the  program,  even  in  its  present  state,  constitutes  an  advanced  nucleus  and 
point  of  departure  for  the  eventual  development  of  a  complete  processor/ 
processor  environment  simulation  and  evaluation  program. 

At  least  equally  important  of  course,  are  the  facts  that  (a)  it  has,  as 
indicated  above,  served  as  a  practical  test  bed  for  the  MLI  specification 
concept  and  (b)  its  design  illustrates  how  one  might  design  a  processor  ir  any 
HOL  language,  either  to  verify  (and  adjust)  a  selected  mechanization,  or  even 
to  translate  the  selected  mechanization  into  an  actual,  real-time  HOL  system 
navigation  program. 


a .  General  Organization 

In  programming  this  version,  extensive  use  has  been  made  of  the  sub¬ 
routines,  array  structuring,  and  indexing  features  of  FORTRAN  IV.  Dynamic 
forcing  inputs  are  of  course  (as  indicated  above)  not  available,  and  output 
routines  have  not  been  included,  since  in  checkout  these  depend  on  the  check¬ 
out  technique  employed,  and  for  any  particular  working  application  depend  on 
the  output  coordinates  peculiar  to  the  application  itself  (e.g.,  latitude- 
longitude,  UTM,  etc.).  On  the  other  hand,  internal,  intermodular  communication 
has  been  embedded  (but  not  yet  fully  checked  out)  via  storage  in  appropriate 
common  blocks,  organized  so  as  to  ensure  that  the  most  recently  computed 
results  will  always  be  used. 

The  program  has  been  organized  into  five  basic  modular  groups:  the  start¬ 
up  and  initialization  modules,  the  DR  navigation  modules,  the  reference  modules, 
the  Kalman  modules,  and  the  special  output  modules.* 


*Note  that  these  groupings  differ  slightly  from  the  MLI  groupings  in  that  each 
of  the  switching  modules  has  been  embedded  as  part  of  the  group  of  modules  it 
controls.  This  is  not,  however,  a  real  difference,  but  only  one  in  point  of 
view. 
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Of  these,  the  D,  R,  and  K  module  groups  (which  modular ly  embed  the  dynamic 
mode,  configuration,  and  C  frame  switching  operations)  together  comprise  the 
dynamic  navigation  loop,  and  the  special  output  modules  (none  of  which  are 
included)  comprise  the  functions  necessary  for  any  of  a  wide  class  of  output 
operations  (e.g.,  conversion  of  internal  C  frame-referenced  navigation  quanti¬ 
ties  to  output  display  coordinates  or  control  signals) = 

The  start-up  and  initialization  modules,  in  addition  to  embedding  the  MLI 
CONM  and  NSTM  functions,  also  configure  the  processor  in  accordance  with  the 
navigation  equipment  complement  available  (i.e.,  any  subset  of  the  overall 
IMU/AHRU/CADS/ttansceiver  equipments  which  the  current  MLI  processor  is  capable 
of  processing).* 

Another  noteworthy  (and  prospectively  very  useful)  feature  of  the  program 
is  its  algorithm  timing  flexibility.  Under  input  control,  each  module  or 
algorithm  thereof  can  optionally  be  executed  at  any  desired  frequency  relative 
to  a  basic  frequency,  or  even  bypassed  entirely. 

In  actual  operation,  all  data  constants  and  variables  are  saved  in  labeled 
common  storage  and  are  Initialized  in  the  block  data  routine.  During  turn-on, 
each  basic  module  group  is  called  and  executed  once  to  initialize  fixed  or 
specific  arrays,  pointers,  algorithm  timing,  etc.  Navigation  sensor  equipment 
characteristics,  error  models,  and  availabilities  are  input  by  the  NSTM  and 
CONM  modules.  These  inputs  are  read  using  the  FORTRAN  Name  List  function. 

After  all  required  initial  inputs  are  read  and  verified,  dynamic  main  loop 
operation  begins,  with  the  DR  navigation  mode,  the  R  configuration,  the  C  frame, 
and  the  K  configuration  respectively  and  continuously  controlled  by  the  DSWM, 
the  RSWM,  the  CSWM,  and  the  KSWM.  This  is  accomplished  by  setting  internal 
pointer  and  software  configuration  markers  to  control  the  execution  of  only 
those  algorithms  appropriate  to  the  selected  type  of  processor  operation. 

In  this  functionally  limited  program,  only  the  IDR  mode  algorithms  are 
programmed.  However,  the  markers  and  specific  entry  points  for  ADR  and  PDR 
operations  have  been  included  so  that  the  mode-specific  algorithms  can  later 
be  inserted  with  absolutely  no  change  to  the  program  organization.  Figure  32 
is  a  summary  block  flow  diagram  of  the  program  organization. 

Table  LXXVIII  summarizes  the  main  program  organization  in  terms  of  the 
FORTRAN  flow  and  command  symbology  actually  implemented. 


*It  is  this  processor-configuration  feature  which,  if  appropriately  general 
ized,  could  comprise  an  important  step  toward  eventual  realization  of  an 
HOL  software  generation  program. 
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TABLE  LXXVIII.  MAIN  PROGRAM  ORGANIZATION  SUMMARY 


BLOCK  DATA  (all  common  arrays,  constants,  etc.) 


END 


MAIN  PROGRAM 


r 

MAIN 

CALL  SET-UP  (initialize  variable  arrays) 

CALL  CONVM  (input  fixed  constants) 

(  CALL  NSTM  (input  start-up  condition  of  arrays  and  pointers) 
CALL  PROCES  (processor  main  loop  timing/execution  control) 
CALL  EXIT  (end  of  job) 

RETURN 

END 


f  SUBROUTINE  PROCES 


(labeled  conmon  arrays  and  variables) 


i 


v. 


INIT. 


DYN. 

NAV 

LOOP 


CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

• 


DR  NAV  (initializes  each  D  module  to  specified  configuration) 


RF  NAV  ( 
KALMAN  ( 
SPECAL  ( 


R 

K 

0 


DSWM 

CSWM 

CALM 

PLAM 


CALL  KMCM 
I  CALL  OSWM 
l  CALL  OUTM 


The  entire  control  program  thus  consists  essentially  of  subroutine  calls; 
each  call  (e.g.,  CALL  FLAM)  shifts  program  control  to  the  execution  group: 


ENTRY  PLAM 

<  (PLAM  Module  Operations) 

RETURN 

This  arrang«;r«nt  efficiently  allows  for  retention  of  module  processing 
capability  even  in  the  absence  of  that  module.  A  similar  capability,  using  the 
FORTRAN  GO  TO,  DO  loop  and  CONTINUE  operations,  is  embedded  at  the  intramodular , 
specific  algorithm  level  as  well. 
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The  remaining  paragraphs  of  this  subsection  present  the  principal  features 
and  specifics  of  the  FORTRAN  IV  program.  It  should  be  kept  in  mind  in  reviewing 
this  discussion  that  almost  all  of  these  features  and  specifics  are  strongly 
influenced  by  the  structure  and  characteristics  of  the  higher  order  language 
(FORTRAN  IV),  the  compiler  (FORTRAN  IV/IBM  370/65),  and  the  machine  (IBM  370/65) 
employed.  The  techniques  selected  therefore  represent  the  best  programming 
compromise  in  the  programmer's  judgment  --  and  against  the  background  of  the 
limited  time  allotted  --  to  realizing  a  program  nucleus  capable  of  generaliza¬ 
tion  in  any  one  of  the  several  directions  discussed  earlier.  (See  the  introduc¬ 
tion  to  Section  IV.) 

b.  Switching  Modules* 

This  paragraph  briefly  describes  and  defines  the  markers  used  in  the  pro¬ 
gram  to  implement  processor  DR  navigation  mode,  reference  navigation  configura¬ 
tion,  and  C  frame  switching  requirements;  i.e.,  the  functions  of  the  DSWM, 

CSWM,  RSWM,  and  KSWM  modules  respectively.  Descriptions  of  the  functions  of 
these  modules  has  been  emitted  here,  since  these  have  already  been  presented  in 
the  corresponding  MLI  module  specifications.  The  markers  are  summarized  by 
module  in  Tables  LXXIX  through  LXXXII. 


TABLE  LXXIX.  DR  NAV  MODE  SWITCHING  MODULE  (DSWM)  MARKERS 


Marker 

Description 

Marker 

Values 

Meaning 

DEJQM 

Current  DR  Equipment  Availability 

l 

No  IMU,  AHRU  or  TAS 

DEQO 

Previous  DR  Equipment  Availability 

2 

AHRU  and  TAS  only 

3 

IMU  only 

4 

IMU  and  TAS  only 

5 

IMU,  IAS  ar.d  .AHRU 

DIMU 

Current  IMU  Availability 

l 

No  IMU 

2 

IMU  type  (F) 

3 

IMU  type  (S> 

DIDR 

IMU  Status  Control 

l 

Coarse  Align 

2 

Fine  Align 

3 

Alignment  Complete 

4 

IMU  Nav  Mode  (IMU 

only) 

5 

IMU  &  TAS  only 

b 

IMU,  AHRU  6.  TAS 

*£n  addition  to  the  required  CSWM,  this  paragraph  discusses  the  D,  R,  and  K 
switching  modules,  which  are  not  required  for  the  limited,  single-mode  program 
scenario  assumed  here,  but  which  h«we  nevertheless  been  preliminarily  formu¬ 
lated  to  provide  a  built-in  base  for  later  inclusion  of  full-mode  switching 
capability. 
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TABLE  LXXIX.  (Continued) 


Marker 

Description 

Marker 

Values 

Meaning 

DAHS 

AHRU  Availability 

1 

No  AHRU 

2 

AHRU  DG  Mode 

3 

AHRU  MAG  Mode 

DAHR 

AHRU  Status  Control 

1 

No  AHRlt  4  TAS 

2 

AHRU  Align 

3 

AHRU  Align  Complete 

A 

AHRU  DG  Mode 

5 

AHRU  MAG  Mode 

DTAS 

TAS  Availability 

1 

No  TAS 

2 

TAS 

DRMM 

Current  DR  Nav  Mode  Marker 

1 

PDR  Mode 

DRMO 

Previous  DR  Nav  Mode  Marker 

4. 

ADR  Mode 

3 

IDR  (IMU  only) 

4 

IDR  (IMU  &  TAS) 

5 

IDR  (IMU,  TAS,  AHRU) 

TABLE  LXXX.  C  FRAME  SWITCHING  MODULE  (CSWM)  MARKERS 


Marker 

— 

Marker 

Description 

Values 

Meaning 

CFRM 

Current  Nav  Reierenct-  <C)  Frame 

1 

No  change 

i  ...  ii 

2 

Switch  Initialization 

KFFN 

C  Fram*  Switching  Time  Control 

1 

Do  not  Switch 

2 

Complete  KF  Switching 

3 

Kalman  Switch  Completed 

TABLE  LXXXI.  REF  NAV  MEASUREMENT  CONFIGURATION 
SWITCHING  MODULE  (RSWM)  MARKERS 


Marker 

Description 

Marker 

Values 

Meaning 

EBAR 

Altitude  Control 

1 

No  Baro  Altitude 

2 

Pseudo  Altitude  Only 

3 

Baro  Altitude 

4 

Field  Altitude  and 

Baro  Altitude 

5 

Field  Altitude 

6 

Pseudo  and  Field 

Altitude 

DALT 

Altitude  Available 

ALMM 

Altitude  Mode 

REQM 

Ref  Nav  Equipment 

1 

No  Change  in  Equipment 

Availability  Marker 

Availability  Status 

2 

Change  in  Equipment 

Availability  Status 

TABLE  LXXXI I .  KALMAN  FILTER  SWITCHING  MODULE  (KSWM)  MARKERS 


Marker 

Description 

Marker 

Values 

Meaning 

KEQM 

KRMM 

REQM 

REQO 

As  Defined  Above 

II 

tl 

<1 

KALL 

Select  KF  Module  Set  to 

Execute 

NOMS 

Number  of  Measurements  to 
Process  from  Previous  Cycle 

DSWTH 

DR  Nav  -  Switched 

1 

2 

No  Switch 

DR  Switched 

RSWTH 

Ref  Nav  -  Switched 

NOSW 

Number  of  DR  Nav  Switches  in 
Previous  KF  Interval 
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c.  Other  Modules 


The  programming  of  almost  all  other  (i.e.,  nonswitching)  modules  so  closely 
follows  the  MLI  specification  as  to  be  self-explanatory.  No  further  definition 
is  therefore  given  here. 

d .  Array  Structure 

The  program  extensively  defines  and  utilizes  FORTRAN  data  arrays  to 
facilitate  handling  of  the  multidimensional  data  sets  associated  with  (1) 
reference  navigation  measurement  type  availability,  (2)  selected  measurement 
processing  for  the  Kalman  filter,  and  (3)  Kalman  filter  estimate  and  covariance 
matrix  processing.  These  are  discussed  in  turn  in  the  following  paragraphs. 

(1)  Reference  Navigation  Measurement  Type  Availability  Arrays 

The  one-dimensional  array  RKRAY(N)  is  used  to  define  the  availability  and 
viability  of  reference  navigation  measurement  equipment  and  output  data.  In 
this  array  the  ranges  N  =  1  to  5,  6  to  10,  11  to  15,  and  16  to  20  respectively 
contain  reference  altitude,  reference  ground  LOS  emitter,  reference  airborne 
emitter,  and  reference  NAVSAT  emitter  data.  In  each  such  block  of  5  words, 
the  individual  words  represent  the  information  summarized  below  (for  each  of 
the  equipment  group  types  just  identified) . 

The  first  word  of  each  block  defines  the  current  equipment  status  accord¬ 
ing  to: 

1  =  Data  input  available  from  this  net 

2  =  Add  new  emitter/ input  to  this  net 

3  =  Drop  emitter/ input  from  this  net 

4  =  Drop  complete  net,  discontinue  processing  data  from  this  net 

5  =  Add  a  complete  net. 

Words  2  through  5  define  emitter  type  and  number  according  to; 

1  =  Emitter  data  available 

2  =  Add  to  net  this  emitter 

3  =  Drop  emitter  from  net 

4  =  Spare 

5  =  Spare 
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(2)  Measurement  Processing  Arrays 

The  3-dimensional  array  PHI  (L,M,N)  is  used  here  (a)  to  save  data  appro¬ 
priate  for  synchronized  measurement  matrix  generation  at  the  end  of  the  KF 
cycle,  and  (b)  to  save  data  appropriate  for  KF  DR  mode  switching  operations  in 
the  next  KF  cycle.  The  indices  N,  M,  and  L  respectively  denote: 

N  =  Inde.:  of  raw  measurement  data  type. 


M  =  Index  of  set  of  scalars,  vectors,  and  matrices  associated  with  use  of 
a  raw  measurement  data  type  N;  i.e.,: 


1. 

“d 

6. 

“fe/C 

2. 

yd 

7. 

Tp/c 

3. 

At 

8. 

CD 

4. 

Av 

9. 

yr 

5. 

Ap 

10. 

CR 

index  of 

elements 

of 

each 

n.  Mj^ 

12.  Measurement  type 

13.  Emitter  number 

14.  Clock  (net) 

15.  Propagation  data 

of  the  entities  of  index  M. 


Another  3-dimensional  processing  array,  DDM  (L,M,N)  is  used  for  several 
purposes  in  the  program,  one  of  the  more  important  of  which  is  in  the  synchronized 
measurement  time -smoothing  operation.  The  indices  M,N,  and  L  here  respectively 
denote: 


M 


N  = 


index  of  raw  measurement  type;  i.e.: 

1.  Position  4.  Range  rate  (LOS) 

2.  Altitude  5,  Range  (EM) 

3.  Range  (LOS) 

index  of  data  group  types  associated  with  measurement  type  M;  i.e.; 

'•  V  V  V  V  >V  "r. 


2. 

NDs 

3. 

*Ds 

4. 

*Ds 

index  of 

data 

L  ■  index  of  data  within  group  type  N  of  measurement  type  M. 
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(3)  Ke'Han  Filter  Arrays 


Substate-partition-related  arrays  are  used  extensively  to  store  the  variable 
sets  defined  in  the  detailed  KF  structure  tables  of  the  MLI  KF  structure  speci¬ 
fication.  Since  these  are  directly  patterned  on  the  MLI  specification,  no 
further  definition  is  given  here. 


e.  Subroutines 

Both  common  and  special  FORTRAN  subroutines  are  employed  extensively  in 
the  program. 

The  common  subroutines  consist  almost  exclusively  of  vector -matrix  opera¬ 
tions;  a  few  of  these  are  general  (IBM  370/05,  FORTRAN  IVH  extended)  FORTRAN  V 
library  subroutines,  but  the  main  body  are  navigation-specialized,  Northrop 
library  subroutines.  The  common  subroutines  are  summarized  in  Table  LXXXIII. 

The  special  subroutines,  which  were  developed  specifically  for  this  pro¬ 
gram,  are  of  two  kinds:  (1)  those  which  were  designed  in  conjunction  with,  and 
facilitate  the  use  of,  the  special  data  arrays  described  above  (e.g.,  the 
special  subroutine  MXMV  used  in  the  KF  measurement  processing  modules),  and  (2) 
those  which  mechanize  operations  which  are  expected  to  be  highly  application- 
dependent  (e.g.,  the  VSTM  gravity  computation). 


TABLE  LXXXIII.  COMMON  AND  MATHEMATICAL  SUBROUTINES 


Mnemonic 

Description 

DOT 

Dot  product  of  two  vectors 

ADOT 

Angle  between  two  vectors  (in  degrees) 

ADOTR 

Angle  between  two  vectors  (in  radians) 

FNORM 

Normalize  a  vector 

VNORM 

Normalize  a  vector 

VCROS 

Vector  cross  product 

VADD 

Vector  addition 

VSUB 

Vector  subtraction 

VSCL 

Scalar  times  a  vector 

VCXR 

Vector  times  a  vector  transpose  (outer  product) 

VRCX 

Vector  transpose  times  a  vector  (inner  product) 

VMOV 

Vector  transfer 

AD  DM 

General  matrix  addition* 

SUBM 

General  matrix  subtract* 

MPYM 

Matrix  multiply  general* 

MTRA 

Matrix  transpose  general* 

VTRT 

Matrix  transpose  times  a  vector  (3x3)T  (3x1) 

MTRT 

T 

Matrix  times  matrix  transpose  (3x3)  (3x3) 

VTRN 

Matrix  times  a  vector  (3x3)  (3x1) 

MTRN 

Matrix  times  a  matrix  (3x3)  (3x3) 

WCROS 

Vector  into  rotation  matrix 

STRN 

Rotation  (of  a  vector)  about  a  coordinate  axis  (3x1) 

GTRN 

Generates  a  rotation  matrix  about  a  line  (3x3) 

GTSN 

Generates  a  rotation  matrix  in  terms  of  successive 

rotations  about  3  axes  (3x3) 

INVERT 

Invert  a  matrix 

MSCL 

Scalar  times  a  matrix 

MG  ID 

Generate  identity  matrix 

SINE 

Sine  of  an  angle 

COSINE 

Cosine  of  an  angle 

SQRT 

Square  root 

♦Essentially  unmodified  FORTRAN  library  subroutines 
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Given 

a  vector  b, 

8  |  b| 

bT 

=  8b,  where  fbT  ls  a  unit  vector  pointing 

in  the  direction  of  b. 

(140) 

bT  d(b) 

s  TbT  3t 

(141) 

4M 

_  {  b  b  Tl^b_  .  A 

Identity  Matrix 

(142) 

"  r  ‘  |  b!  lb!  J  |b|  ’ 

Proof 

of  (140): 

| b |  |b |  =  | b | 2  =  bTb,  which  implies  that 

5 {|  b  1 1  b  |}  *  S(  bTb} 

Evaluating  both  sides  yields: 

T 

2  |b  j  5  | b |  =  2bT  5b->8|bj  -  6b 


Proof  of  (141.)  : 


Again  evaluating  both  sides, 


T  d(b)  4d|b|  bT 
'  dt  dt  |  b | 


Proof  of  (142) ; 


SLU.  lb  I  g(b)  -  (b)  jib] 
llblj  |b||b| 


Substituting  in  the  results  of  (140)  above  yields 


b 

t]bTJ 


.1 

ibi 

6(b)  b  bT  > 

\  _fib  L  .  b  bT  } 

r 

|b| 

1  b  |  \|b||b|  , 

1  jb|  l1  |b | 1 b | J 

-fib 

I  b  I 
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APPENDIX  I 


SOME  BASIC  VECTOR/MATRIX  RELATIONSHIPS 


This  appendix  derives  several  basic,  mathematical,  vector /matrix  relation¬ 
ships  which  are  employed  In  the  derivations  In  subsequent  appendices. 


Consider  any  two  orthogonal  frames  Fl  and  F2.  Denoting  the  orthogonal 
transformation  from  Fl  to  F2  by  Tp2/Fl* 

^J^F2  "  ^F2/F1  ^J^Fl  ^  (23) 

where  Is  a  unit  vector  along  the  J**1  axis  of  frame  F2.  Taking  the 
time  rate  of  change  of  both  sides  of  equation  (23)  gives 

*re/ri  <Vfi  +  Tn/n  <Vn  ’  0  ()  '  1'2'3)  <“> 

If  ujpj /pi  denotes  the  angular  rate  of  F2  with  respect  to  Fl,  It  Is 
true  that: 


(Vf1  "  ^°JF2/Fl^Fl  X  (VjVl  ^  "  1,2,3)  *25^ 

Substituting  this  result  In  equation  (24)  gives 

^F2/F1  +  TF2/F1  (UW/F1^F1  *  ^  V  "  °  <2b) 

where: 


!  <Vn  I  <Vf13  ■  Tn/FJ  C<V1>FJ  |<V  *  T: 


F  1 
*2 


F1/F2 
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and  1^2/fPfI  x|  18  th*  ®*trix  equivalent  of  the  vector  cross 
product  operation;  l.e., 

To  *2 

|(U,F2/F1>F1X|  -  *3  0  ““l 

tttj  0 

where  u)j,  (4,,  Uij  are  the  components  °f  ^/Fl  in  the  F1  frame* 


Since  V  ■  Tf1/F2  is  invertible>  ic  follows  by  postraultipl'cation  of 
equation  4)  by  V"1  -  that; 


Equation  (27)  is  the  first  of  the  desired  relationships.  It  relates 
the  time  rate  of  change  of  an  orthogonal  matrix  to  the  matrix  itself 
and  to  the  angular  rate  vector  as  shown. 


A  second  useful  relationship  is  obtained  from: 

TF1/F2  TF2/F1  "  1  (28) 


Taking  the  time  rate  of  change  of  this  equation,  and  postmult iplying 
the  result  by  ^^1/^2*  *eatl®  t0  the  r,e®ired  second  relationship: 


Equation  (20)  simply  expresses  the  relationship  between  the  time  rate 
of  change,  of  the  transformation  *nd  °*  *ts  inver$e 

TF1/F2* 


Pre-  and  post  multiplication  of  equation  (27)  by  Tp^p,  and  use  of  equa¬ 
tion  (29)  on  the  result  leads  to: 


319 


^“ta/FlVl  X  ^  TF1/F2 


(30) 


TF1/F2  " 


But  since  FI  and  F2  are  conceptually  interchangeable,  equation -(30) 
can  also  be  written: 


where  use  has  been  made  of  the  fact  that 


“F1/F2* 


Equation  (31)  is  an  alternate,  equally  useful  form  of  the  relationship 
inherent  In  equation  (27). 


Equating  the  right  sides  of  equations  (27)  and  (31)  leads  to: 


Equation  (32)  is  a  formula  for  transforming  the  angular  rate  cross 
product  matrix  from  one  oichogonal  frame  to  another.  Still  another 
useful  relationship,  known  as  Coriolis'  law, is  obtained  as  follows 
from: 


(a)F2  *  TF2/F1  (a)Fl 


(33) 


where  a  is  any  vector.  Taking  the  time  rate  of  change  of  equation 
(33)  gives: 


•  •  • 

(s)f2  “  (a>Fi  +  Tf2/F1  *a)Fl  (34) 

Using  equation  (? 7 )  in  equation  (34)  gives: 

(a)F2  *  TF2/fl  ^Fl>  ’  ^V/Fl^Fl  X  |  (t)Fl  ^  (33) 

from  which  it  follows  that: 

TF1/F2  ^*^F2  ’  (*^F1  ’  ^°V2/FpFl  X  ^  **Vl  (3b) 
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Applying  the  time  derivative  notation  defined  in  the  Symbol  Glossary 
finally  gives: 


Another  formula,  which  is  used  for  error  equation  linearization  in 
Appendix  III  >  j.8  stated  here  without  proof ,* 

(38) 


Two  final  formulae  are  also  useful.  If  a  and  b  are  any  (3x1)  vectors, 
then: 

(ax)  (bx)  -  (bx)  (ax)  =*  -  j(axb)xj  (39) 

and: 

(ax)  (ax)  =  aa^  -  a^al  (40) 

These  formulae  can  both  easily  be  verified  by  carrying  out  the  indicated 
operations  at  the  scalar  level. 


i 

|  *The  proof  requires  use  of  matrix  concepts  more  advanced  than  are  pertinent 

to  this  development.  See,  for  example,  NASA  Contractor  Report  CR-968,  "A 
|  Study  of  the  Critical  Computational  Problems  Associated  with  Strapdown 

Navigation  Systems",  April  1968,  (Appendix  C) . 
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APPENDIX  II 


GENERALIZED  DR  NAVIGATION  EQUATIONS 

This  appendix  derives  a  set  of  basic,  generalized,  vector /matrix,  terres¬ 
trial  DR  navigation  equations.  These  equations  provided  the  partial  basis 
for  processor  reference  frame  selection  and  for  IDR,  ADR,  and  PDR  equation 
definitions. 


The  basic,  terrestrial  navigation  acceleration  equation  is: 


“i2p 

dt2 


~  f  +  G 


(41) 


Using  Coriolis'  law  (see  Appendix  I)  and  the  definition  of  v  (see  the 
Symbol  Glossary)  leads  to; 


d  P 

-dt  "  V  +  <“E/IX>P 


(42) 


and  further: 

,2 


dIP  dcV  /dcaE/TX\  dcP 

-i  ■  Jr +  Hnr- 1?  *  <“k/i»  a r +  <“c/ix)  + 


dt 


again  using  Coriolis'  law,  it  follows  that 


(43) 


dt  *  ^/C^^/I 


(44) 


and  also  that; 


d  P 

-JT  *  v  +  <“E/CX>P  (45> 

Substitution  of  these  results  into  equation  (43)  and  of  that  result  into 
equation  (41)  leads  to: 
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e  4.  »  _  f/o  i.>  4-  ul  wl,. 


(A6) 


Where  g  ■  G  -  (WE/IX)(WE/IX)P 

Equation  (46)  is  the  desired  generalized  acceleration  equation,  and  equation 
(45)  is  the  desired  generalized  relationship  between  position,  velocity, 
and  angular  rate. 

If  the  C,  P,  and  E  frames  have  relative  angular  rates  with  respect  to  one 
another,  then  it  is  necessary  to  initialize  the  transformations  between 
these  frames  and  subsequently  to  continuously  update  them  according  to  the 
equations  [see  Equation  (31)  of  Appendix  l"l . 


TC/E  “c/e'c*}  tc/e  <47) 

Tc/p-  fc-Wc*]  Tc/r  1  <48> 

The  angular  rate  (wc/£)c  required  by  equation  7)  is  obtained  by  solution 
of  equation  (45)*.  The  angular  rate  (u?yc)(,  required  by  equation  (48),  how¬ 
ever,  must  be  computed  for  inertial  navigation  from  a  formula  derived  as  follows: 


^P/^C  "  ^  P/I  "  w C/E  ’  w E/I^C 


Therefore,  if  the  inertial  platform  is  strapdown: 


(  “'p/C^  "  TC/P*WP/I*P  ’  ^  w  C/ E^C  '  Tc/E  ^E/I*e[ 


♦For  the  case  of  special  Interest  C  ■  L,  equation  (45)  can  be  shown  to 
reduce  to  h  ■  Vj  and  ■  K^v^,  where  the  3X3  earth  radii  of  curvature 

matrix  is  a  function  of  h  and  certain  elements  of  T^g. 


where  (*^p/];)p  obtained  (after  suitable  calibration  corrections)  easen> 
tially  as  the  outputs  of  the  strapdown  gyros. 

On  the  other  hand,  if  the  inertial  platform  is  gimballed,  (<fyc)c  roust  be 
specified  computationally**.  Once  this  is  done,  then  the  platform  gyro  con¬ 
trol  torquing  rates  can  be  essentially  specified  as: 

^P/I^P  "  TP/C  [(wP/CJC  +  ^ W C/B^C  +  TC/R*wE/I*e]  <51) 


**For  example,  for  the  case  C 


E  and  F  a  L,  .s  wp/c  ■  Tc/pK,_  Tp/C» 
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APPENDIX  III 


IDR  NAVIGATION  AND  ERROR  EQUATIONS 


This  appendix  derives  the  processor  IDR  navigation  and  navigation  error 
equations,  predicated  on  the  frame  selection  C  ■  E  (or  EF)  and  P  =  L. 


1.  IDR  NAVIGATION  EQUATIONS 

For  the  choice  C  =  E,  it  follows  that  u^E  =  0,  and  the  processor  accelera¬ 
tion  and  velocity  equations  can  be  written  down  direction  from  equations  (46) 
and  (45)  of  Appendix  II  as*. 


T  f 
C/P  P 


♦  -  fc+g-2(afe/ix)v 

P  -  v 


(52) 

(53) 

(54) 


Also  in  this  case,  the  need  for  mechanizing  equation  (47)  of  Appendix  II  is 
obviated,  since  again,  u^E  =  0.  On  the  other  hand  [see  equation  (31)  of 

Appendix  I  and  equation  (48)  of  Appendix  IIj: 


(33) 


is  required  for  updating  Tp^c#  If  the  platform  is  strapdown, 
puted  for  use  in  equation  (55)  [see  equation  (50)  of  Appendix  II): 


is  com- 


p  * 

“V/iIp  '  Tp/C  ^/I 

(56) 


*For  compactness  here,  C-subscript ing  of  vectors  is  omitted. 


where  **  obtained  directly  as  the  (compensated)  strapdown  gyro  out¬ 

puts.  On  the  otherhand,  for  the  glmballed  platform  case,  the  selection 
P  ■  L  leads  to  (see  Appendix  II  footnotes): 


p/c)p  “  \7?/cv 


(57) 


and  the  required  (uncompensated)  platform  control  torqulng  rate  from 
equation  11)  of  Appendix  II  la: 


(•»«] 

lp'l 

(“p/c! 

|p  +  TP/C  tt,E/I 

(58) 


To  complete  these  equations,  fp  for  equation '  (52)  is  generated  from  the 
accelerometer  outputs  fACC>  *nd  from  the  accelerometer  outputs  calibration/ 
shaping  compensation  Af  as: 


f 


P 


fACC 


+  Af 


(59) 


Also,  the  angular  rate  callbratlon/shaplng  compensation  Aw  Is  used  to 
correct  (u)p/j)p  in  equations  (56)  and  (58)  so  that: 


where  ojGyp  la  the  actual  gyro  outputs  for  the  strapdown  case,  and  the  actual 


gyro  control  torqulng  rates  for  the  glmballed  platform  case.  Equations  (52) 
through  (58)  comprise  the  set  of  basic  mechanization  equations  for  the  case 


OE.*  For  the  case  OEF,  It  should  first  be  noted  that  again, 


0. 


In  addition,  since  C  Is  a  constant  vector  In  any  earth-flxad  frame,  It 
follows  that  p  ■  P.  Finally,  It  Is  assumed  that  at  the  time  of  E  to  EF 
transition,  p  (■  P-C) ,  v,  and  Uig/j  are  transformed  Into  the  EF  frame,  and 


Tp/C  Is  adjusted  to  account  for  the  change  In  C  frame,  according  to  the 


equations: 


★Equations  (59)  and  (60)  do  not  depend  on  the  choice  of  the  C  frame,  and 
thus  are  the  same  for  CaE  or  C*EF. 
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In  these  equations,  it  should  be  noted  that  is  a  fixed  transformation. 

With  these  preliminaries,  it  is  evident  that  use  of  the  generalized  equations 
of  Appendix  II  for  the  case  C  *  EP  will  lead  to  a  set  of  mechanization  equa¬ 
tions  which  is  functionally  identical  to  those  above  for  the  case  OE*,  except 
that : 

a)  Equation  (54)  is  replaced  by: 

(62) 

b)  The  E  frame  computation  of  gravity,  g  -  8E(pE)  Mu8t  be  replaced  by  the 
computation: 


Finally,  in  EF  to  E  transition,  equations  (52)  through  (58)  will  subsequently 
be  valid  if  the  following  switching  operations  are  carrier  out: 


*  It  should  be  recalled  that  all  unsubscriptcd  quantities  in  equations  (52) 
through  (60)  and  all  tine  derivatives  are  referred  to  the  C  frame,  be  it  E 
or  EF. 
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2.  IDR  NAVIGATION  ERROR  EQUATIONS 

A  fundamental  preliminary  to  the  development  of  the  inertial  navigation 
equations  (for  the  selections,  C  ■  E  or  EF,  and  P  »  L  or  strapdown)  consists 
in  the  identification  of  two  different  seta  of  navigation  equations,  the 
differencing  of  which  leads  directly  to  the  desired  error  equations. 

The  first  of  these  two  sets  describes  the  computational  process  which  is 
actually  carried  out,  as  follows: 


A  A  A 

fC  *  *C/P  *ACC+  Af* 

(65) 

v  -  2C  +  g($)  -2<u>e/iX)  v 

(66) 

•  •  0 

A  A 

P  ■  p  ■  v 
<0 

(67) 

?P/C  -  -  [(“p/cV1]  %/c 

/  EITHER  TYPE  ) 

\  OF  PLATFORM  / 

(68) 

"  “gyr  'Au)*  ^p/c  ^E/I 

^TRAPDOWN  \ 
^PLATFORM  J 

(69) 

•  KlTP/CV 

/LOCAL  LEVEL,  \ 

(70) 

[  WANDER  AZIMUTH) 

“an  ■(l“p/c)p  *  Tp/c ^e/i  +  a* 

\  PLATFORM  / 

(71) 

In  these  equations,  the  superior  hat  above  a  quantity  indicates  that  it  Is 
only  an  onboard  computational  estimate  of  the  value  of  the  quantity,  and 
not  in  general  the  true  value.  That  is,  these  equations  describe  the  actual 
onboard  processing  of  specific  force  as  measured  by  the  accelerometers,  Into 
estimated  velocity,  position,  and  torqulng  rate  signals  (for  the  estimated 
plat f orra-to-< omputer  transformation,  and,  in  the  rotatlonally  isolated 
platform  case,  for  the  platform  gyros). 

The  second  set  of  navigation  equations  Is: 


fC  "  TC/P  fP  (72) 

»-fc+HP)-2(»e/Ix)v  (73) 
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r  «  p  «  v 


(74) 


(EITHER  TYPE\ 
OF  PLATFORM J 


(75) 

(76) 


All  quantities  here  are  unhatted  to  indicate  that  they  are  true,  rather  than 
estimated  values.  These  equations  describe,  a)  the  processing  of  true  (as 
opposed  to  measured)  specific  force,  resolved  into  the  computational  frame 
using  the  correct  transformation  between  platform  and  computer  frames,  into 
true  velocity  and  position,  and  b)  the  behavior  of  the  actual,  as  opposed 
to  the  estimated,  orientation  of  the  platform. 

The  error  equations  can  now  be  obtained  as  follows.  To  begin,  direct 
differencing  of  equations  (65)  with  (72),  (66)  with  (73),  and  (67)  with 
(74)  gives: 


a  A 

where  the  error  quantities  are  defined  as  5V  ■  V  -  V,  8P  *  P  -P  An 
A  ’  v 

and  8  T  ■  T„.  -T„._. 

C/P  C/P  C/P 

Noting  that: 


(77) 

(78) 

(79) 

(80) 
(81) 


A 

P-P, 


A 

T  ,  a  t  A 
C/P  C/P 


it  follows  that: 


A 

AT  «  T  -T 
C/P  C/p  C/P 


T  A  f  T 
C/P  1  L 


('-  tp/p) 


(82) 


(83) 
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The  dynamic  behavior  of  T£yp  is  obtained  as  follows.  Since: 

TA,  =  TA,  T  , 

P/P  P/C  C/P 

it  follows  that,  U3ing  equation  (68),  and  equations  (27)  and  (32)  from 
Appendix  I: 

T?/P  ■  *pVc/P  +  T?/C*C/P 


[(3p/c)px1  ^p/c^c/p  +  Tf/PTP/cTc/P 
[(»p,c)px]  t?/p  +  T?/p[(“p/c)pxj 
fTp/p|“p/cjpxj  Tp/p  ’[(“p/c)p  *]] 


or  finally: 


^p/?  "  [j^/p^p/cjp  '  (w p/c)p  )  X  j 


To  continue,  denote: 


Q  «  Tp/p-I 


So  that  equation  (83)  becomes: 


8TC/P  ■  -Tc/p(I+<!)'  5 


and  equation  (85)  becomes; 


^  “  [|  (I+Q)t°p/c)p  ‘  f°p/c)p  )x]  (1+Q) 
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But: 


^P/C^P  *  ^P/I^P  ‘^E/I^P 
and,  using  equations  (69),  (70),  and  (76': 

(“p/c)p  -(“p/i)p  -<I4<»  (“e/i)p  -  64  “ 

for  both  the  strapdown  and  rotationally  free  platform  cases,  where: 

A 

8Aw  =  Aw-Aw- 


(89) 


(90) 


(91) 


Using  equations  (89)  and  (90)  in  (88)  leads  to: 


-i 

Q  = 

\f  p/i)p  +  S4“)x 

(ThQ) 

(92) 


Equations  (77)  through  (81),  (87),  and  (92)  together  comprise  a  set  of  non¬ 
linear  error  equations  in  the  closed -loop  error  variables  6V,  8p  or  8p, 
and  Q,  and  in  the  forcing  error  variables  Sfp  andSAo*  These  equations  must 

however,  be  linearized  for  use  in  designing  the  processor  Kalman  filter 
There  are  two  principal  steps  involved  in  doing  this:  a)  the  lineariza¬ 
tion  of  the  dynamic  platf orm-to-computer  misalignment  error  requation  (92)", 
and  the  linearization  of  the  gravity  error  equation  (81)  . 

To  linearize  equation  (92),  denote  by  y  the  vector  representing  the  instan¬ 
taneous  angular  misalignment  between  the  estimated  and  actual  attitude  of 
the  inertial  platform.  Using  equation  (38)  of  Appendix  1,  it  follows  that: 

Tp^£  =  I  cos  |«//j  +  (1-cos  |(/,|)  uu^-sin  j  •A  |  ( ux>  (93) 

where  u  »  0/|i//|  is  the  unit  vector  about  which  the  rotation  angle) '/'I  is 
defined.  1  1 

If  I'l')  is  small,  Tp^£  can  therefore  be  linearly  approximated  by: 

tp/*«I-#0()  (94) 
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So  that: 


Q  =  <#*) 


(95) 


Using  this  result  In  (92)  gives: 

Op/)  *  jj  OP/)  (u>p/1)p  +  «A»}xj  [l  +(^pX)J 

So  that,  to  the  first  order: 

Equation  (81)  can  be  linearized  as  follows.  To  start,  note  that: 
g(P)  -  G(P)  +  Ag(P) 


(96) 


(97) 


(98) 


where  Ag(P)  is  the  small  difference  between  mass  attraction  and  plumb-bob 
gravity.  Since  I  Ag|  is  at  most  leas  then  1/3  of  one  percent  of  | g| ,  it 
can  be  neglected  in  deriving  a  linearized  error  relationship  between  fig  and 
fiP. 

Thus : 

68  -  g(P)  -  g(P)  «8gA  +  C(?>  -G(P) 
or 

fig  -  figA  -  CGfiP  (99) 

where  fig^  is  the  error  in  gravity  due  to  sources  other  than  position  error 
(e.g.,  gravity  anomalies)  and  is  the  matrix  relation  between  the  position- 
error-dependent  gravity  error,  and  the  position  error.  In  particular: 

r  0G 

LG  23  “5p  ( 100) 
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For  navigation  in  the  E  frame,  C^,  can  be  shown  to  be  given  by*. 


(101) 


On  the  other  hand,  for  navigation  in  the  EF  frame,  8g  becomes: 


5gEF  *  TEF/E  SgA  '  TEF/E^CG^E  5PE 
But  since  8pe  «  5pEp,  it  follows  that: 

5gEF  “  TEF/E  5gA  *  EF^F 


(102) 


(103) 


where 


'■'Vef  =  tef/e  ((Ve  te/ef 


Substitution  of  equation  (98)  in  (101)  leads  to: 


Thus  CG  can  be  represented  in  either  the  E  or  EF  frames  by: 


and  the  gravity  error  by: 


(104) 


(105) 


( 10b) 


8g  -  8gA  -  Cg8P  (0R8p) 


(107) 


where  figA  is  the  non-position-error-dependent  gravity  error  expressed  in  the 
C  frame . 


*  See  G.  Pitman  (ed .) ."Inertial  Guidance",  J.  Wiley  &  Sons,  1962,  Chapter  1. 
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Finally,  substitution  of  equation  (95)  in  (87),  and  substitution  of  the  result 
in  (78)  leads,  after  linearization,  to: 


8£c-Tc/p  {8£p+<£p*> 


(108) 


and  substitution  of  equation  (107)  into  (79)  leads  to; 


6V 


6fc  + 


68 


;A  -  CG  8 P  (or  fp)  -  2  (o^/i;X) 


6  V 


(109) 


Equations  (108),  (109),  (80),  and  (97)  together  comprise  the  desired  set  of 
linearized  Inertial  navigation  error  equations. 

Switching  of  the  eiror  equations  must  be  carried  out  when  the  navigation 
equations  are  switched.  The  appropriate  error  switching  equations  are  ob¬ 
tained  as  follows . 

Direct  linear  perturbation  of  equations  (61  a,b)  and  (64  a,b)  gives*: 


*>  8vef  ■  tef/e  8ve 


b)  8pef  ■  tef/e  8pe 


(E  to  EF) 


(110) 


a)  SvE  -  TEF/E6vEF 


b)  SPE  ■  ^F/E^EF 


(EF  to  E) 


(HI) 


Also,  since  the  location  of  the  EF  frame  is  known  with  respect  to  the  E 
frame  (see  footnotes)  and  the  earth  rate  vector  is  known  in  the  E  frame, 
this  vector  is  also  known  errorlessly  in  the  EF  frame.  For  this  same 
reason,  no  change  in  the  platform-to -computer  misalignment  is  required 


*  Cg  and  are  errorless  by  definition;  i.e.,  the  location  of  the  center 

of  the  EF  frame  in,  and  .its  attitude  with  respect  to,  the  E  frame  are  assumed 

known,  although  the  position  and  velocity  of  users  and/or  emitters  and/or 

other  points  in  the  EF  frame  with  respect  to  the  EF  frame  are  in  general 

assumed  to  be  in  error.  This  philosophy  leads  to  a  more  contact  overall 
mechanization  than  do  alternative  philosophies. 
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at  the  time  of  C  frame  switching,  since  the  C  frame  is  known,  be  it  E  or  EF. 

No  additional  error  contribution  to  t p?  is  therefore  introduced  by  switching. 

Equations  (HO)  and  (111)  therefore  define  all  necessary  error  switching  opera¬ 
tions  . 
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APPENDIX  IV 


ADR  NAVIGATION  EQUATIONS 


This  appendix  derives  the  processor  ADR  equations,  predicated  on  the 
frame  selection  C*EF. 

In  ADR,  since  the  basic  driving  DR  navigation  information  is  available 
at  the  velocity,  rather  than  the  acceleration  level,  no  acceleration-level 
processing  is  required.  Integral  processing  is  therefore  confined  to  the 
equation: 


p  *  v 

The  velocity  v  for  this  equation  is  obtained  from: 

v  =  V  +  V 

W  AS 

The  C -frame -referenced  airspeed  vector  v^g  is  obtained  from: 


VAS  "  TA/C 


(vas); 


(112) 


(113) 


(114) 


and  the  airframe  (A  frame)  referenced  airspeed  vector  from: 


(VAS ) A  “  TA/A,kA/A'  (|VASM 


Avasm|) 


(115) 


where  |VASM|  is  the  measured  (scalar)  airspeed,  | ^VASJ^  |  is  the  airspeed  bias 

and  scale  factor  correction,  and  • ^A/A'  is  a  combined  angle  of  attack 

correction  and  vectorizing  operator  (i.e,,  to  convert  airspeed  from  a  scalar 
to  a  vector).  Finally  the  A-to-C-frame  transformation  required  by  equation 
(114)  is  generated  from; 


TA/C  "  iA/PTP/C 


(lib) 


and  T.  , 

A/P  from: 

1A,?  «  FUNCTION  OF  AHRU  ATTITUDE  READOUTS 

Discussion  of  Tp^  generation  is  deferred  for  the  moment  since  it  relates 
to  wind  vector  generation  for  equation  (113). 
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Equation  (113)  requires  a  C-frame-referenced  wind  vector.  In  ADR, 
generation  of  wind  in  any  frame  is  of  course  based  on  some  initial,  a  priori 
wind  vector  estimate  which  is  subsequently  decayed  in  the  absence  of  further 
information.*  A  natural  frame  in  which  to  conduct  this  basic  wind  estimation 
process  is  the  L  (locally  level)  frame.  In  particular,  to  maintain  maximum 
inter-DR-mode  commonality  of  processor  algorithms,  this  L  frame  should  be  the 
same  as  that  used  in  IDR;  i.e.,  a  wander  azimuth  frame.  The  wind  processing 
equations  are  therefore: 


(117) 


(118) 


where  is  an  appropriate,  wind  estimate  decay  (diagonal)  matrix. 

Returning  now  to  consideration  of  T p^c  generation  for  equation  (116),  a 
natural  way,  which  makes  use  of  TLyc,is: 


TP/C  "  tp/ltl/c 


(119) 


This  equation  of  course  requires  separate  generation  of  Tp^L  and  T^c 
by  means  of 


II 

CJ 

-J 

•H 

“V/c^l  x  Tl/c 

(120) 

w 

K/l)p  *  tp/l 

(121) 

where  (^/C)L  is  obtained  (as  in  IDR  for  P  -  L)  from: 

(“1/c)l  *  kltl/cv 

(122) 

and  (“V/Jp  from: 


♦This  estimate  can  of  course  be  corrected  (e.g.,  via  a  Kalman  filter)  if 
external  measurements  of  groundspeed  (e.g,,  from  continuous  pseudoranging 
and/or  pseudorange -rating)  are  available. 
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=  0  if  AHRU  platform  i3  in  DG(wander  azimuth)  mode 

=  local  meridian  convergence  rate  (i.e.,  azimuth  rate  equal  to 
vehicle  longitude  rate  multiplied  by  the  sine  of  vehicle 
geographic  latitude) 


finally,  again  to  maintain  maximum  inter-DR -mode  processor  algorithm 
commonality,  since  (120)  and  (121)  must  be  computed  in  ADR  and  strapdown  IMU 
IDR  anyway,  then  if  the  hardware  configuration  involves  both  an  AHRU  and  a 
rotationally  free  IMU,  (120)  and  (121)  should  also  be  implemented  in  IDR, 
instead  of  the  simpler  equation  (44)  of  Appendix  II  alone.  In  addition, 
carrying  the  additional  Tp^  transformation  desirably  generalizes  processor 

IMU  acceleration  data  processing  and  torquing  control  rate  capabilities. 
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APPENDIX  V 


PDR  NAVIGATION  AND  ERROR  EQUATIONS 


This  appendix  discusses  the  PDR  mechanization  and  error  equations  based  on 
the  assumption  C=EF. 

1.  PDR  NAVIGATION  EQUATIONS 

The  C -Frame -referenced  aircraft  acceleration  equation  is: 


±L  *  f 

dt 


+  g  -2 


“k/i 


X  V 


(123) 


where,  as  usual,  the  C-frame  subscripting  is  omitted  for  brevity. 
The  corresponding  equation  referenced  to  an  L  frame  is: 


d.  v 


dt  =  fL  +  gL  "(2Ut/l  +  ‘‘L/cIl  X  VL 


(124) 


and  the  two  equations  are  related  by: 


dv  T 

— —  S  T 

dt  L/C 


d  v 
LL 

dt 


+  (“1/c)l  x  vlI 


(125) 


Now  consider  in  particular  the  L  frame  defined  by  the  orthogonal  unit 
vectors*: 


u.  *  -8— ,  u-  ■ 
1  I  g  I  2 


V  x  u 


1 


VXUjj'  3 


u,  x  u  ,  V 


(126) 


i.e.,  the  locally  level  frame  with  its  horizontal  axes  down-and  cross-ground- 
track.  In  particular,  the  TL^C  transformation  can  be  defined  conveniently  in 

terms  of  these  unit  basis  vectors  as: 


L/C 


i  ■ 

U.I  U-i  u, 
l|  J 


(127) 


♦Note  that  this  L  frame,  although  it  has  the  same  vertical  axis  as  the  wander 
azimuth  L  frame  used  in  IDR  and  ADR,  has  its  horizontal  axes  constrained  to 
fallow  the  horizontal  projection  of  the  vehicle  velocity  vector. 
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Consider  the  bracketed  term  on  the  right-hand  side  of  (125).  If  the  air 

craft  is  flying  at  constant  speed  and  altitude  (this  does  not  preclude  turns) 

d  v 
L  L 

then  -jj—  =  0,  and  the  overall  term  reduces  to: 


H/c)lxvl  ■ 

“i/ci 

4./C2 

X 

'  0 

0 

at 

’  °i/c2\3 
-Ui/C1VL3 

.  o  . 

_VL3_ 

0 

(128) 


Thus,  if  the  aircraft  is  not  turning,  only  the  earth-centripetal  (radial)  term 
Ui/C2VL3  *S  Pre8ent*  ^  the  aircraft  is  also  turning,  then  the  additional 
turn-centripetal  term  is  re<luired  as  well. 


If,  further,  the  aircraft  is  either  or  both  horizontally  (along-track)  and 
vertically  accelerating  or  decelerating,  then: 


Vl 

dt 


V 
0 

V 


(129) 


combining  results: 


d  v 
L  L 

dt 


H/c) 


L  X  VL 


2 

v^  .  (start  cr  end 

-  (always)  +  v,  ,  of  climb) 

|  pe|  u 

UL/C 1 VL3  (in  turn) 

v  ^  (horizontal  acceleration/ 
deceleration) 


(130) 


In  PD»\,  the  horizontal  (along-track)  and  vertical  accelerations  v  ,  and  v 

L  J  LI 

and  the  turning  rate  (necessary  to  determine  the  cross-track  turning  accelera¬ 
tion)  are  not  directly  measurable,  but  must  be  inferred  (after  integration, 
using  pseudorange  and/or  range-rating  data).  Calling  the  acceleration  vector 
composed  of  th»se  three  components  /9,  then  the  overall,  C-Frame-referenced 
acceleration  cat.  be  written: 
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V 


TL/C  (^L  " 


$  -  * 


(131) 


where 

\r 

•  »l»l2  ■  (vTui)' 

r 

*L  ■ 

■l  " 

0 

0 

- 

The  (3  components  can  be  simply  modeled  for  use  in  this  equation  as  ex- 
L 

ponentially  time-correlated  variables;  i.e.: 

A  i  -  ■  \i  -  1,2,3)  (132) 

L1  T/?Li 

where  the  correlation  times  depend  on  the  direction  u^  involved,  and  on 

the  type  of  maneuver,  per  the  following  table; 


No 

Maneuvers 

Start  of 
Climb  or 
Descent 

A long -Track 
Acceleration  or 
Decelerat ion 

Turn 

>L1 

TflLNl 

fj9LS  1 

T3LNl 

T0LN1 

JpL2 

T/?LN2 

Tj3LN2 

T/3LN2 

*/?LS2 

t/5L3 

T/9LN3 

T<?LS3 

T/SLS3 

TflLNi 


Nominal,  no-maneuver  value 


T/3LS  i 


Shorter,  maneuver  value 


In  particular,  the  shorter  correlation  times  are  used  for  both  components 
of  horizontal  acceleration  throughout  a  turn  to  account  for  the  change  in  effec¬ 
tive  acceleration  due  to  the  change  in  the  groundtrack  direction  relative  to 
wind  direction. 


Information  from  the  flight  control  system  (e.g.,  throttle  setting,  con¬ 
trol  surface  settings,  etc.)  could  presumably  be  used  to  control  the  maneuver 
indicators  required  by  implication  in  the  above  T^^-setting  table.  If  not, 

single,  fired  values  (which  would  have  to  be  intermediate,  compromise  values 
between  the  no-maneuver  and  maneuver  values)  would  have  to  be  used  instead. 


341 


Combining  results,  the  PDR  mechanization  aquations  are; 


v  "  tl/c^l"®l) 


tl/c 

■  hi-,:-,' 

\f 

r 

u. 

-  1  -  u  — 

u.  * 

1 

1*1  2 

yxu“’ 

3 

Ai 

a 

K 

'K£l/*L 

\ ■ 

^L2 

(133) 

(134) 

(135) 

(136) 


V  - 

r^i  settings  per  table  from  flight  control  data,  or  single,  fixed  values 
(P»  P£,  g£,  g,  | h |  equations  same  as  for  IDR) 


2,  PDR  QIROR  EQUATIONS 

In  the  acceleration  equation  (131), 

;  ■  TuciV\) 

T 

the  terms  /3^  and  a^  model  L  frame  accelerations,  and  Tj ^  is  the  matrix 

necessary  to  express  them  in  the  C  frame.  By  direct  linear  perturbation,  the 
corresponding  error  equation  is: 


6v  ■  TL/C6^l  +  'L/C^L"*l)’”l/C  5aL 

But  since  both  T.^,  and  a^  are  Juat  velocity  dependent,  while 

acceleration  dependert,  for  short-time  extrapolations  the  last  two 
be  neglected  so  that: 


(137) 

only  is 
terms  can 


-  tUc«l 


(-38) 
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Also,  by  direct  perturbation: 


(  «L  -  -K  A 

v  6p  =  6v 


No  gravity  error  feedback  (via  position  error)  coupling  into  the  acceleration 
error  equation  is  needed  here,  since  computed  gravity  is  not  used  in  the 
acceleration  equation  (except  to  compute  the  direction  u^;  but  6T^  error 


effects  are  neglected) . 
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APPENDIX  VI 


BASIC  MEASUREMENT  MATRICES  DERIVATION 


This  appendix  is  devoted  to  the  derivation  of  the  basic  measurement  (M) 
matrices  for  the  following  general  types  of  measurements:  range,  range-rate 
and  barometric  altitude.  A  high  level  of  commonality  between  the  various  M 
matrices  was  considered  to  be  of  primary  importance  in  the  development. 

In  taking  measurements  (range  or  range-rate)  relative  to  emitters  the 
question  arises  as  to  whether  or  not  emitter,  as  well  as  user  location  errors 
should  be  modeled  and  estimated.  If  it  is  decided  that  emitter  location 
errors  should  be  estimated,  then  there  is  the  possibility  these  errors  are 
interrelated.  If  this  is  so,  and  the  interrelationships  are  known,  then 
the  number  of  error  state  variables  required  to  be  carried  by  the  Kalman 
filter  may  be  significantly  reduced.  The  number  of  measurements  required 
to  estimate  the  emitter  errors  would  also  be  reduced  by  a  like  amount. 

Consider,  for  example,  a  situation  in  which  the  user  is  operating 
with '.n  range  of  a  network  consisting  of  four,  earth  fixed,  range  type  emit¬ 
ters.  Assume  that  emitter  position  errors  are  to  be  estimated.  Now  if  the 
emitUr  location  errors  are  not  correlated,  or  if  they  are  but  this  fact 
is  not  used  in  the  estimation  process,  then  a  total  of  twelve  state  error 
variables  are  required  in  the  filter  model.  Further,  twelve  different 
scalar  range  measurements  are  required  to  estimate  the  twelve  state  error 
variables. 

Depending  upon  the  circumstances,  a  second  alternative  might  exist. 
Consider  the  case  where  the  first  emitter  is  located  by  some  means  and  then 
the  second,  third  and  fourth  emitters  in  the  network  are  located  relative 
to  the  first.  Assume  that  distances  between  emitters  is  known  quite  pre¬ 
cisely  but  that  errors  in  local  vertical  and  true  north  are  present,  in 
the  process  of  locating  these  emitters.  In  this  situation,  the  four  emitters 
might  be  considered  as  four  points  in  a  rigid  body  which  has  three  trans¬ 
lational  error  components  (those  due  to  the  location  errors  of  the  first 
emitter)  and  three  rotational  error  components  (those  due  to  errors  in  local 
vertical  end  true  north).  For  this  case,  the  position  errors  of  all  four 
emitters  may  be  estimated  using  only  six  error  variables  and  six  different 
scalar  range  measurements.  If,  during  the  locating  of  the  last  three 
emitters,  true  north  and  local  vertical  were  also  known  precisely,  then  only 
three  error  variables  are  required.  Finally,  under  certain  circumstances, 
it  may  be  that  no  emitter  error  state  variables  are  required,  i.e,,  emitter 
locatlonsare  known  precisely  and  no  emitter  position  error  estimates  are 
required. 

In  the  derivations  of  this  appendix,  the  worst  case  has  been  assumed, 
i.e.,  the  M  matrices  provide  for  the  inclusion  of  three  error  variables  for 
each  emitter  whose  position  error  Is  to  be  estimated. 
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Range  measurements  are  of  two  general  types,  line-of -sight  (LOS)  range 
measurements  and  earth-mode  (EM)  range  measurements.  Earth -mode  measurements 
(e.g.,  LORAN  or  Omega)  are  processed  differently  than  are  LOS  measurements. 
But  more  importantly,  from  the  standpoint  of  generating  M  matrices,  the  in¬ 
formation  content  in  an  EM  range  measurement  is  less.  Since  EM  signal  propa¬ 
gation  is  based  upon  the  concept  of  a  spherical  waveguide ,  there  is  no  way  to 
relate  changes  in  user  altitude  to  changes  in  measured  range.  For  this  rea¬ 
son  EM  range  measurements  must  be  restricted  such  that  they  are  used  only 
to  estimate  position  errors  in  the  local  horizontal  plane  (local  horizontal 
at  the  user  and  emitter  positions);  LOS  and  EM  measurements  are  therefore 
discussed  below  in  separate  subsections. 

There  are  a  number  of  symbols  which  are  used  in  this  appendix  and  which 
are  not  defined  in  the  glossary.  Some  are  defined  in  the  text  at  the  time 
they  are  used;  however,  some  which  are  used  more  generally  throughout  this 
appendix  are  defined  below: 


Symbol  Definitions 


[ UNITY ]  is  a  row  vector  in  which  every  element  is  unity 

is  a  row  vector  in  which  every  element  is  zero 
=  Transpose  of  the  quantity 

=  the  sum  of  all  scalar  time  correlated  errors  associated 
with  a  specific  j11^1  radio  ranging  measurement 

*  the  sum  of  all  scalar  time  correlated  errors  associated 
with  a  specific  radio  range-rate  measurement 

faF  dF*|  «  gradient  of  F 

ap  "  |_ax  3y  azj 

The  gradient  of  scalar  functions  is  used  throughout  this  appendix  (both 
implicitly  and  explicity)  to  expand  computed  functions  about  their  actual 
values  using  a  Taylor  series  expansion.  Second  and  higher  order  terms  in 
these  expansions  are  always  neglected  (to  arrive  at  linear  relationships), 
which  is  valid  when  the  computed  value  is  very  close  to  the  actual  value. 
This  condition  is  always  assumed.  Further,  since  the  actual  values  of  the 
function  argument  variables  are  never  known,  the  resulting  partial  deriva¬ 
tives  are  evaluated  using  the  estimated  values  of  these  variables.  This  is 
also  reasonable  where  the  errors  are  very  small. 

In  an  attempt  to  avoid  derivations  within  a  sect.*  '?  which  detract  from 
the  main  thought,  three  identities  (which  are  used  wit  ±n  the  sections)  are 
defined  and  proved  as  follows. 


[—  ZERO  —  ] 
Superscript  T 

8  *ii  ■  'N 

8  \  -  -8Stj 
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Given  a  vector  b, 
,  T 


b  * 

8|b|  =  ~  8b,  where  ~  is  a  unit  vector  pointing 


I  b  I 

in  the  direction  of  b. 


bT  d(b) 

|7T  dt 


>(tM  -  {*  - 


b  b 

|  b|  Ibl 

Proof  of  (140): 


|b|  » 


Identity  Matrix 


| b j  |b  |  =  | b  | ^  ■  bTb,  which  implies  that 

«{|b||b  |}  -  «(bTb} 

Evaluating  both  sides  yields: 

T 

2  |b j  8  |b|  =  2bT  8 b  -$>8|bj  -  «b 


Proof  of  (1^1)  '• 


f  Ibl2 

dt 


3T  (»Tb) 


Again  evaluating  both  sides, 


’I  del ' 


I  4(b)  4dLb|  ,  bl  d_  , 

D  | b |  dt  v  ' 


dt 


dt 


Proof  of  (1^2) ; 

.Ibl  lb  I  6(b)  -  (b)  6  Ibl 
ll  b|  J“  I  b  |  j  b  | 

Substituting  in  the  results  of  (140)  above  yields 


rjbi 


\ 

Ibl  6(b)  */b  bT  ^ 

\  31  .  It  .  b  bT  | 

r 

lb)  |b|  \|b||b. 

I  ibl  r  |b 1 1  b  |  J 

Ibl 

(140) 

(141) 

(142) 
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1.  RANGE  MEASUREMENTS  (LINE -OF -SIGHT) 


In  this:  subsection,  M  matrices  are  developed  for  line-of -sight  range 
measurements  which  are  consistent  with  both  the  OE  and  C=EF  computational 
frames.  For  the  OE  frame  case,  the  range  between  the  user  and  the  jth 
emitter  is  given  by 

|  Rj |  =  |  p  +  d  -E j |  (143) 


where  P,  d  and  E  are  as  defined  in  the  symbol  glossary.  Briefly,  P 
is  the  vector  distance  from  the  center  of  the  earth  to  the  center  of  the 
user  platform  frame;  d  is  the  vector  distance  from  the  center  of  the  user 
platform  frame  to  the  user  receiving  antenna;  E  is  the  vector  distance  from 


th 


j 


the  center  of  the  earth  to  the  j  emitter  antenna 


Now,  let 


(144) 


(145) 


represent,  respectively, 
to  the  range  between  the  user 


the  measured  and  computed  values  corresponding 
and  the  j1’*1  emitter. 


To  generate  the  M^  measurement  matrix,  the  measured  range  is  subtracted 
from  the  computed  range  after  the  S|Rj|  term  in  equation  (145)  has  been  expanded 
in  terms  of  system  variables.  Taking  the  first  variation  of  |R.|  ,  defined 
in  equation  (143),  yields: 


5bl 


P+d  -E 


(14b) 


Now,  using  equation  (140),  (identity  #1), 


*1 


P+d-E 


j 


(P+d-Ej)1 
jp+d -Ej  I 


(8P  +  8d  -  SEj) 


(147) 


where  the  vector  quantity, 


(P+d-E.) 
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is,  by  definition,  a  unit  vector  which  points  from  the  j  emitter  antenna 
to  the  user  antenna.  Let  this  unit  vector  be  defined  as  r..  Using  this 
definition,  one  can  rewrite  equation  (147)  as  ^ 

fi|p+d-Ej |  -  r ^  .  (6P+8d  -SEj)  (148) 

Now,  subtracting  equation  (144)  from  (145)  and  utilizing  the  results 
of  equations  (146)  and  (148)  produces  the  following  equation: 


|ARj|  =  r*  .  (SP  +8d  -«Ej)  +  8RTj  +  nRj(t)  (149) 

It  turns  out,  as  will  be  shown  later,  that  the  term  fid  in  equation  (149) 
provides  a  means  of  estimating  errors  in  the  transformation  matrix,  T^A> 

which  relates  the  computation  frame  and  the  aircraft  frame.  Neglecting 
for  the  moment  the  8d  term,  equation  (149)  in  vector-matrix  notation  becomes: 


AR. 

J 


rj  !  [ZERO]  !  -r ^  j  [ZERO]!  [UNITY]  j  [ZERO] 


8P 


+n_  .  (t) 
Rj 


(150) 


From  equation  (150),  the  FL  matrix  is,  by  definition, 


M . 


r*  '  [ZERO]  j  -r j  |  [ZERO]'  [UNITY]  |  [ZERO] 


(151) 


In  equation  (145),  the  vector  d  represents  the  vector  distance  from  the 
center  of  the  platform  frame  to  the  user  antenna  expressed  in  C  frame  coor¬ 
dinates,  If  the  effect  of  this  separation  distance  is  to  be  taken  into 
account  (both  for  range  and  range-rate  measurements)  then  the  vector  d  must 
be  an  input  parameter.  However,  since  d  is  physically  measured  in  airframe 
coordinates,  then  the  input  will  be  in  airframe  coordinates.  The  computa¬ 
tional  algorithms  then  must  take  into  account  the  necessary  conversions. 


Let  d^  represent  the  physical  measurement  of  d  expressed  in  airframe 
coordinates',  then 


d 


C/A 


(152) 
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Using  equation  (152), 


6i  -  «c/A  dA  +  Tc/a  6dA 


(153) 


but  6d^  ■  0  since  d^  is  a  known  constant  vector  in  airframe  coordinates; 
hence,  equation  (153)  reduces  to 


dd  -  «Ic/AdA 

Now,  let  the  3x3  error  matrix,  6Tc be  represented  by  its  three-row 
vector  partitions;  i.e.,  let 

Csti3 


(154) 


6Tc 


/A 


C«2] 

Ot33 


(155) 


Using  equation  (16),  one  can  now  rewrite  (154)  as: 


6Tc/AdA 


To  simplify  notation,  let 
6Tc/AdA  "  D6TC/A 


‘6T.  •  d  ' 

r  T  T-i 

d‘*6T 

r 

1  A 

A  1 

{VdA 

m 

dA,4I2T 

m 

6T_  •  d  A 

'd?«  6T  T 

3  A 

mr  mi 

A  3 

im  mi 

L 

(3x9) 

d/l  0  I  0  " 

-*-U  -I-- 

0  Id  T  I  0 

J  _A_  .1 _ 

0  !  °  !d*Tj 


(9x1) 

F6tiT 

6T2T 

6T,T 


(156) 


(157) 


/A' 


The 


where  D  is  understood  to  be  the  3x9  matrix  in  equation  (156)  and  6T^a 
is  the  (9x1)  vector  representation  of  the  error  matrix  6Tc 
TjT*6d  term  in  equation  (149)  now  becomes 

tjl.dd  -  (rjT  D]  6Tc’/a  (158) 

where  t'j1  »]  is  a  (1x9)  row  vector. 
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Now,  if  errors  in  the  Tc^A  transformation  matrix  are  to  be  estimated, 
then  the  Mj  matrix  and  state  error  vector,  defined  by  equation  (150), 
are  modified  and  become: 


£  rjT  | [r j  d]i  [ZERO]  j  -r^ZERo]  |[uNITy]  ;  [zBRo]JT6Pt__ 


6Tc 


i 

i 


"V*) 


(159) 


In  the  C  *  EF  frame  case,  the  center  of  the  EF  frame  is  translated  from 
the  center  of  the  E  frame  through  the  vector  distance  C;  and  the  coordinate 
axes  of  the  EF  frame  are  related  to  the  E  frame  coordinate  axes  through 
the  orthogonal  transformation  TEF/E‘ 

To  fix  ideas  in  the  following  derivation,  use  is  made  of  the  following 
vector  diagram  :  : 


Figure  33.  I, OS  Emitter /User  Geometry 
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where,  now  p+d  is  the  vector  distance  of  the  user  antenna  with  respect 
to  the  EF  frame  center,  and  e^  is  the  vector  distance  of  the  jth  emitter 

antenna  with  respect  to  the  center  of  the  EF  frame. 


Now,  from  Figure 


'j 


P  +  d  -  E 


j 


p  +  d  -  e 


j 


The  measured  range  is  (as  before)  defined  by  equation  (144) 
the  computed  range  be  defined  by: 


(160) 
Now,  let 


/v 

R, 

m 

R, 

+  fi 

R, 

j 

j 

j 

P  +  d  -  ej  +  8 


p  +  d  -  e 


j' 


(101) 


Following  the  identical  procedure  as  described  above  to  evaluate  the 
<5|p  +  d  -  e  |  term  in  equation  (161)  yields 


5  p  +  d  -  e^  |  *  (6p  +  fid  -  fie^) 


j 


j' 


(162) 


where  t.-,  fip,  fid  and  fie.  are  all  expressed  in  C  *  EF  frame  coordinates. 
J  J 

The  fid  term  can,  as  before,  be  used  to  estimate  errors  in  the  trans¬ 
formation  matrix  which  relates  the  C  ■  EF  frame  and  the  user  aircraft 
frame.  (Note:  In  the  previous  consideration,  T^^  *  *A/E*  w^ereas 


here  T 


A/c 


TA/EF* } 


As  a  result,  equation  (162)  yields  an  Hj  matrix  which  is  identical  to 

the  Mj  matrix  defined  by  equation  (150)  (if  the  fid  term  is  neglected), 

or  equation  (159)  (if  the  fid  term  is  used  to  estimate  transformation 
errors).  The  M  matrix  elements  are  computed  in  the  operating  frame 
coordinates,  usir.g  parameters  measured  relative  to  the  center  of  this 
frame . 


2.  RANGE  MEASUREMENTS  (EARTH  MODE) 


As  described  above,  the  information  contained  in  an  earth  mode  range 
measurement  must  be  restricted  such  that  it  is  used  only  to  estimate 
position  errors  in  the  local  horizontal  plane,  at  both  the  user  and  the 
emitter  locations.  Even  with  this  restriction  it  is  still  possible 
to  derive  M  matrices  for  this  mode  of  operation  which  display  a  certain 
level  of  commonality  with  the  M  matrices  developed  for  LOS  measurements. 
This  commonality  is  achieved  using  the  same  unit  vector,  r  ,  developed 


in  Section  1  above,  and  then  rotating  this  unit  vector  into  the  local 
horizontal  plane.  The  following  paragraphs  describe  this  procedure  in 
detail,  in  which  the  C  *  E  frame  case  is  considered  first. 
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To  provide  a  good  insight  into  the  derivations  of  this  section,  use 
is  made  of  the  following  sketch  where  for  simplicity  the  vector  A  is 
used  (A  *  P  +  d)  rather  than  P  +  d;  "user  position"  implies  user 
antenna  position  and  "emitter  location"  implies  emitter  antenna  location. 


A 


Figure  34.  Earth-Mode  Emitter/User  Geometry  ( 1) 


In  this  sketch,  A1  is  the  point  on  the  earth's  surface  directly  below 
the  user  position,  Ag  is  the  geocentric  latitude  and  is  the  angle 

between  the  vectors  A'  and  Ej .  Let  j  Sj j  represent  the  actual  distance 

between  the  emitter  position  and  the  point  A'  as  measured  along  the 
surface  of  the  earth. 


The  computed  value  of  the  distance 
following  line  integral: 


can  then  be  expressed  by  the 


(163) 
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and  the  measured  value  of 


can  be  expressed  as 


IViHsjl  -  +V'> 


(164) 


The  value|ASj|  then  is  arrived  at  by  subtracting  equation  (164)  from 

(163),  The  M  matrices  for  this  mode  of  operation  are  not,  however, 
developed  by  operating  on  equation  (163)  because  of  the  altitude 
restriction,  but  rather  as  follows. 

As  noted  in  Section  1  above,  r^  is  a  unit  vector  which  points  from  the 
emitter  to  the  user  along  the  lineof  sight.  Now,  assume  that  the  line 


of  sight  distance  between  the  emitter  and  user  ( 


,  where  is  as 


described  in  the  sketch)  is  much  greater  than  the  altitude  of  the  user. 
Under  this  assumption,  and  for  the  purposes  of  the  following  derivation, 
it  is  reasonable  to  assume  that  the  user  is  located  at  the  point  A1. 

(If  this  assumption  is  not  valid,  then  user  altitude  must  be  subtracted 
out  of  the  vector  A  to  arrive  at  A'.  The  derivation  then  continues  as 
described  below. 


The  following  sketch  describes  how  the  earth  mode  M  matrix  is  derived 
using  the  results  of  the  preceding  section. 
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In  Figure  35, 


h  *  unit  vector  along  local  vertical  at  user  position  = 


1ST 


;  as  previously  defined 


T  *  unit  vector  contained  in  both  the  local  horizontal  plane  and  the 
J  plane  containing  the  center  of  the  E  frame,  the  jth  emitter 
location  and  the  user  location 


h  *  unit  vector  along  local  vertical  at  emitter  position  * 
EJ 


t  =  same  description  as  t  except  at  jth  emitter  location. 
EJ  j 


TiJr 


It  might  be  well  to  note  that  does  not  in  fact  point  exactly  along  the 

local  vertical.  However  it  only  differs  from  the  local  vertical  by  the 
eccentric  anomaly  which  is,  at  worst,  approximately  11  arc-minutes. 

For  the  purposes  of  the  M  matrix  this  is  a  very  good  approximation. 


Now,  from  the  sketch  and  the  unit  vector  definitions 
rj  *  (cos  9j/2)  T  +  (sin  0j/2)  h 


(165) 


at  the  user  location  and 


-Tj  --(cos  9j/2)  Tgj  +  (sin  9^/2)  hgj 
at  the  emitter  location. 


(166) 


Solving  equations  (165)  and  (166)  for  and  t  respectively  yields 


j  cos 


Hp?  [rj  - (,ln  v2> h] 


and 


•TCj  '  ^72  [-'j  -(8ln  ®J/2)hEj] 


(167) 


The  unit  vectors  t  and  Tg^  can  now  be  used  to  restrict  the  earth  mode 

measurement  such  that  only  local  horizontal  estimates  of  user  and  emitter 
position  can  be  made,  i.e.,  let 
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m-  t]t 


6A  -  tEj  .  6Ej  +  6RTj  +  nRj(c) 


(168) 


where  Che  radio  navigation  measurement  errors  have  been  added.  Using 
equation  (159) ,  the  | |  equation  for  the  jth  emitter  range  measurement 
then  becomes  J 


itfjl  -  [  T J  !  [  ZERO]  j-Tg  J  |(ZER0]j  [unity] [[ZERO]  jl 


6A 


6E , 


6R 


Tj 


*  nRj(t) 


(169) 


where  fiA  «  fi(P  +  d)  =  fiP  +  fid. 


As  for  line  of  sight  measurements,  the  fid  term  can  be  used  to  estimate 
errors  in  the  transformation  matrix,  Tr/^,  or  it  can  be  neglected.  If  it 

is  neglected,  then  fiA  =  fiP.  If  it  is  not  neglected,  then  a  (1  x  9)  row 
T 

vector,  £r  D],  is  added  to  the  M  matrix  and  a  (9  x  1)  error  vector,  fiT'  , 

v/A 

as  previously  described  in  Section  1. 

Now  in  comparing  the  form  of  the  matrix  defined  in  equation  (169)  with, 
e.g.,  the  LOS  matrix  defined  by  equation  (150)  (for  this  comparison  let 
fiA  ■  fiP),  it  is  seen  that  the  difference  between  the  two  matrices  can  be 
identified  as  follows: 


and 


-bsHpi)  - (sln  Y2>  hT 

"’tj  ‘  '(ro.  8^/2)  rJ  '  (,ln  ®J/2)  hEj 


(170) 


For  8,  ■  0,  equation  (169)  reduces  to  equation  (150),  as  can  be  seen  by 


J 


Inspection  using  equation  ( 1 70)  .  The  same  applies  for  the  case  where  errors 

1. 

rj 


in  Ta^c  are  to  be  estimated.  (For  particularly  high  user  altitude  caaea  it 
may  be  desirable  to  scale  t(  by  the  factor  y  or 


Lgh  user  a 1 1 i 

1*1  M  ) 
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An  identical  relationship  exiata  between  the  M  matrices  for  the  case  C  ■  E 
frame,  and  the  case  C  ■  EF  frame  except  that,  when  operating  in  the  EF  frame: 


C  +  o 

F+pT 

.  c  +  el 
|C  +  ej| 

where  C  (expressed  in  EF  frame  coordinates)  is  the  vector  joining  the 
centers  of  the  E  and  EF  frames,  ej  and  p  are  the  jth  emitter  and  user 
locations  respectively  as  measured  in  the  EF  frame. 


(171) 


3.  RANGE -RATE  MEASUREMENTS 

In  this  section,  range-rate  measurements  are  assumed  to  be  made  along  the 
line-of-sight  between  the  user  antenna  and  the  jth  emitter  antenna;  i.e., 
|R  |  is  defined  as  follows: 

l*jl  «  !p  +  d '  "Jl  (l 


(172) 


From  equation  ( 14 1) ; 


IP  +  d  -  Ej 


(P  +  d  -  EJ 


|P  +  d  -  EJ  *V  +  d  ’  VEjJ 


(173) 


Or,  using  the  unit  vector,  r^,  (172)  can  be  rewritten  as 


l»jl  *  rj  •  (V+  d  -  Vgj) 

Now  let  |RJ,  the  computed  value  of  the  range-rate,  be  expressed  as 

l»jl  -  l»jl  +  «i*j! 

and  let  |R*j|,  the  measured  value  of  the  range-rate,  be  expressed  as 

!Rrajl  *  lRjJ  +  6RT  J  +  nRJ(t* 


(174) 


(175) 


(l  7b) 
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Subtracting  equation  (176)  from  equation  (175)  yields: 


Uij!  =  6|Rj  |  +  6^  +  n»  (t)  (177) 

Now,  using  equation  (174),  one  can  rewrite  the  6 1 R j |  term  In.  equation  (177)  as 
6)R  |  =  rT,  •  (6V  +  6d  -  6VEj)  +  (V  +  d  -  V  )  •  6fj  (178) 


To  evalute  6r^  in  equation  (178),  recall  that 


(P  +  d  -  E.)  R. 


r  , 


j  [P  +  d  -  E, 

J 

Then,  using  equation  (142), 


J 1  1  J 1 


(179) 


6fj  =  ^ 


(P  +  d  -  E  . ) 

_  I,  r  Tl 

(  6P  +  6d  -  6E  . ) 

|P  +  d  -  E"!  1 

J  1 

-  l  -  r  .  r  . 

1  J  J  1 

">"+  d  -  T~f 

(180) 


Now,  if  the  results  of  equations  (177),  (  178),  (179),  and  (180)  are  gathered 
together ,  jAR^  now  becomes 

| ARj  |  «  mT  (fiP  +  6d  -  6Ej)  +  r*  (fiV  +  6d  -  6V£.)  +  6^  +  n-  (t)  (181) 

T  (V+d-VE)X  T  t  *T  r  t 

where  m, - - L  [i  -  r.  r .  ]  =  Rj  [i  -  r.r.]  /|Rj| 

•  • 

Now,  note  that  equation  (181)  contains  both  d  and  6d  terms  as  well  as  a  6d 

•  T 

term,  (the  d  term  is  contained  in  nij ) . 

Looking  first  at  d,  and  remembering  that  d  =  T d  ,  it  is  seen  that 


d  ■  TC/A  «a  +  *C/A  ft  (dA). 


(132) 


However, dA  is  a  constant  vector  in  the  aircraft  reference  frame,  hence  the 

m 

time  derivative  of  d  is  equal  to  zero.  Also,  T  -  f  wa  X ]  T_/A. 

A  C/A  L  A/C  J  C  C/A 

Therefore  equation  (182)  can  be  rewritten  as 
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d  ’  f  "a/A  TC/A  dA  ■  [  »A/A  d 


(183) 


where  0)A^C  *  angular  rate  of  the  aircraft  WRT  the  C  frame ,  and 

[tt'A/(,X]c  ■  cross  product  matrix  of  («A^  expressed  in  C  frame  coordinates 


T  • 

That  portion  of  m^  which  contains  d  can  now  be  expressed  as  follows 


(184) 


Now  jd,  as  defined  in  Section  1,  is  given  by: 

6d  "  6TC/A  dA 

Taking  the  time  derivative  of  this  expression,  and  again  noting  that  the 
time  derivative  of  dA  in  the  aircraft  frame  is  zero,  yields 

6d  =  6Tc/a  dA  (185) 

Now  6T£/a  is  a  small  angle  transformation  which  is  the  sum  a)  of  the  f  rota¬ 
tion  and  antenna/airframe  flexure  for  a  strapdown  mechanization,  and  b)  of 
ill,  plus  flexure,  plus  platform  attitude  readout  errors  for  stabilized  plat¬ 
form  mechanizations.  Correspondingly  6TC^A  is  the  sum  of  the  time  rate  of 

change  of  each  of  these  effects.  If  the  update  rate  of  the  T ^yA  trans¬ 
formation  is  sufficiently  fast  to  keep  up  with  vehicle  rotational  motion, 
then  the  only  6d  error  of  consequence  is  that  arising  from  antenna/ 
airframe  flexure  rates.  This  flexure  rate  error  is  more  properly  modeled 
as  time  uncorrelated  noise,  considering  the  relatively  long  Kalman  cycle 
time. 

# 

Assuming  that  the  6d  term  is  modeled  as  noise,  (and  now  contained  in  the 

n*  (t)  term),  then  the  M  matrix  can  be  defined  using  equation  (181),  and 
RJ  J 

is  given  by: 
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M,  =  F m^! rf  ! ZERO  !  -m*  |  -r]  1  ZERO  |  UNITY  '  ZERol 

j  L  jt  j  i  •  j  i  j  i  i  i  J 

where  ':he  6d  term  has  been  neglected. 


(186) 


If  the  6d  term  Is  retained,  then  a  (1  x  9)  row  vector,  rrtjD,  is  added  to  the 
matrix  and  a  (9  x  1)  column  vector  6Tj^  is  added  to  the  error  state 
vector.  The  matrix  D,  and  the  column  vector  6Tj^c  are  both  defined  in 
Section  1  of  this  appendix  and  m^  is  defined  in  equation  (181). 

If  operating  in  the  C  =  EF  frame,  then  [see  equation  (160)]: 


+  d  -  e . 
J 


|Rj  I  =  lp  +  d-Ej!  =  |p 
and  using  equation  (187),  the  range -rate  is  given  by 


(187) 


lR  I  =  j-  |p  +  d  -  e  . 
dt  1  j1  dt  j 


(188) 


From  this  equation,  it  can  be  seen  that  the  same  matrix,  defined  by 

equation  (186),  will  be  arrived  at  where  now  the  variables  are  computed 
with  reference  to  the  EF  frame  center  and  expressed  in  EF  frame  coordinates. 


A.  BAROMETRIC  ALTIMETER  MEASUREMENTS 

The  formulation  of  the  M  matrix  for  altitude  measurements  is  based  upon 
the  geometry  described  in  Figure  jt>. 
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(Center  of  the  E  Frame) 

Figure  36.  Altitude  Measurement  Geometry 


Now  let  the  vector  h  be  defined  as 

h  =  P  -  R  (>.G)  (189) 

This  vector,  h,  ditfers  from  the  actual  vector  altitude  due  to  the  eccentric 
anomalv.  The  difference  in  their  magnitude  is  approximately  one  foot  or  less 
for  altitudes  up  to  100,000  feet.  Hence  to  a  very  good  approximation, 
let  the  scalar  altitude  measurement  be  given  as: 

|h|  «  IP  -  R  UG)I  -  IP  |  -  |R  (\G)|  (190) 

The  terms  |P|  and  |R  (\q) |  can  be  expressed  as 


and 


(X,  Y,  Z)  |  «  x2  +  Y2  +  z2 

(191) 

lRol 

“  ' - 2 - 1172 

(192) 

1  +  k  sin^  xJ 
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where  |Rq|  =  earth  radius  at  the  equator 

k‘  fcrn?‘\] 

e  =  ellipticity  -  1/297.0 

In  the  E  frame,  sin  ■  Z/|p|.  Substituting  this  expression  into  equation 
(192)  yields 

W 


R  (X,  Y,  Z)  |  - 


f1  +  k  (t^-2 - 2) 

L  \X*  +  Y  +  Z  1 


1/2 


(193) 


To  form  the  expression  for  |^h|,  let  I h I  be  the  computed  value  for  |hjAand 

|h  I  be  the  compensated  measurement  of  h|.  Then  subtract  |h  I  from  hi 
1  m  A  1  1  m '  1 

after  expanding  |h ]  in  a  Taylor  series  about  the  true  value  |h|.  This 

results  in  the  following  expression: 


w 


-  1P  •  6P  -  $  (X.Y.Z)  |  -6P  +  6hm  +  nh(t) 


(194) 


where  6h  and  n,  (t)  respectively  denote  the  time  correlated  and  time  un¬ 
til  n 

correlated  altitude  reference  measurement  errors. 

By  definition, 


5,  .  altl  y,  +  6Y  +  m  6Z 


and 


als.a.x.z?|.  jp  .  jx  +  ilil  6y  +  ilil  «z 
aP  1  v  ax  ay  61  az  6 


Performing  the  indicated  partial  differentiations  as  indicated,  and  then 
gathering  together  like  terms  provides  the  following  expressions • 
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These  results  simplify  based  upon  the  following  considerations: 


*  1 


and  k  = 


e  <2  ~  «)  5 

(l-e)(l-e) 


=  2e 


1/150 


Now,  since  Ip|  and  |Rq|  are  of  the  same  order  of  magnitude,  X,Y,  and  Z  are  at 

most  of  the  same  order  of  magnitude  as  |P|,  and  since  2e  *  1/150,  this  implies 
that  the  second  term  in  each  of  the  above  expressions  is  at  least  two 
orders  of  magnitude  less  than  the  first  term.  A  very  good  approximation 
to  equation  (194)  is  arrived  at  by  neglecting  these  terms;  i.e., 


|ihl 


6P 


+  "h(t) 


where 


hi a 


Y  V  7 

TT  W  J] 


(195) 


For  the  case  where  the  computational  frame  is  the  EF  frame,  some  slight 
modifications  result.  The  scalar  |h|  is  generated  in  the  same  fashion  and 
again  the  partial  of  |r|  may  be  neglected.  However,  now 


where  x  ,  y  ,  i  are  the  components  of  the  c  vector  (vector  from  origin  of 
c  c  c 

E  frame  to  origin  of  EF  frame)  expressed  in  EF  frame  coordinates. 
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where: 


APPENDIX  VII 


MEASUREMENT  PREPROCESSING 


This  appendix  summarizes  Che  mathematics  underlying  established  or  promising 
approaches  to  four  different  types  of  measurement  preprocessing  module 
algorithms:  measurement  smoothing,  measurement  reasonableness  testing, 
measurement  selection,  and  measurement  space  averaging. 


1 .  MEASUREMENT  SMOOTHING 

Denote  the  raw  measurement  at  time  t.  within  the  averaging  interval  by  Y, , 

___  1  X 

and  the  smoothed  measurement  by  Y.  Then: 


1  =(.!/")  £  Yt 


(198) 


where  n  is  the  number  of  measurements  Y  obtained  in  the  averaging  interval. 
Next  denote  by  M^  and  V^,  respectively,  the  measurement  matrix  and  the 
measurement  noise  corresponding  to  Y^,  such  that: 


Yi  =  Mi  Xi  +  Vi 

where  is  the  system  state  at  time  t^.  Also: 


‘l  ■  »!,.  *n  -  /  ”  «  <V 


t)  W(t)  dt 


(199) 


(200) 


where  is  the  state  at  time  t^  (taken  here  for  simplicity  as  corres- 

ponding  to  the  end  of  the  filter  cycle),  0,  is  the  state  transition 

i ,  n 

matrix  for  the  interval  t  to  t,f  ®  (t.,  t)  is  the  state  transition  matrix 

n  l  l 

for  the  interval  t  to  t ^ ,  and  W(t)  is  random,  forcing  state  noise. 


Combining  equations  (198),  (199)  and  (200)  gives: 


Y  -  MX  +  V 
n 


(201) 
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where : 


u 

-5-.(i/„)£  Mt  «l  n 


i-1 


_  m  /*  n 

V  “Cl/n)  V  V<  ~(l/n)7  ^  ^  0  (t±t  t)  W(t)  Jt 

i-1  i-1  t. 


The  gain  and  the  covariance  matrix  measurement  update  equations,  which 
determine  the  new  estimate  and  its  associated  covariance  matrix  from  the 
prior  estimate  and  the  smoothed  measurement  Y,  are  derived  using  a  pro¬ 
cedure  identical  to  that  used  in  deriving  the  corresponding  Kalman  equations 
for  simpler,  end-of- interval  measurements.  Since  this  derivation  is 
widely  available  in  the  literature,  it  is  not  repeated  here.  However,  the 
results  are: 

bK  -  (PMT  -  ZT)(MPMT  +  C-  MZ  -  2  M1)"1 

P  -  P-bK  (Mp  -  z) 

where  bR  is  the  gain,  P  is  the  covariance  matrix,  and: 


n 

^  ®1>n 

i-1 


(202) 

(203) 


(204) 


0  (t  ,  T)  K0x  (t  ,  T)  dT 
n  n 


(20  5) 


c’.  (l/n2)^<Vl  V1T>  +(l/n2)^  f  £  (m’  ^  h” 

i-1  j-1 


i-1 


•  I  ^  t  t  m 

+  Mi  Rt  Mj  )  -  Rt  M^ 


(206) 


Note  that  for  the  special  case  of  a  single,  end-of-the-incerval  measurement 

(i.e.,  Y  *  Y  *  Y  ,  t.  *  t  I,  equations  (202)  and  (203)  reduce  to  the  normal 
1  n  i  _  n' 

Kalman  form  |M.  -  M  *  M,  Z  -  0'., 

’  t  n 
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2.  MEASUREMENT  REASONABLENESS  TESTING 


Consider  any  single  measurement  Y.  Denoting  by  Y  the  estimated  value  of 

that  measurement  based  on  the  measurement  matrix  M  and  the  existing  state 

A 

estimate  X,  i.e., 

A  A 


Y  -  MX, 


then  the  difference  D,  defined  by 

A 

D  ■=  Y  -  Y 


(207) 


is  a  convenient  basis  for  a  reasonableness  test  as  follows.  Using 
equation  4)  it  follows  that 

D  *  Me  -  v 

A  A 

where  e  *  X  -  X  is  the  error  in  the  estimate  X. 


(208) 


Taking  the  expected  value  of  the  square  of  D  therefore  gives 
<  D2>  -  <  DDT>  *  MPMT  +  C 


(209) 


An  attractive  reasonableness  test  can  now  be  formulated  as 
D2  s  k2  (MPMT  +  C)  Y  is  reasonable 

D2  >  k2  (MPM^  +  C)  Y  is  not  reasonable 


(210) 


where  k  is  the  number  of  standard  deviations  selected  as  the  reasonableness 
limit  for  |D|. 


3.  MEASURQ1ENT  SELECTION 

Denote  by  ft  and  K,  respectively,  a  generalized  miss  vector  and  its 
(sensitivity  coefficient)  matrix  relationship  to  c,  the  error  in  the 

A 

state  estimate  X;  i.e., 

6  -  Kc  (211) 

The  expected  squared  radial  miss  distance  is  just  the  trace  of  the  miss 
covariance  matrix: 

KPKT  (212) 
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Further,  denoting  by  P  and  P^j,  respectively,  the  estimate  error  covariance 
matrix  Just  before  and  just  after  use  of  a  particular  measurement  Yj 
(measurement  matrix  Mj  and  measurement  noise  Cj),  then  the  change  in  the 
expected  squared  radial  miss  distance  is  just: 

K(PAj  -  P)  KT 

But  since  (assuming  for  simplicity  that  all  measurements  Yj  are  scalar): 


(213) 


P  -  P  * 
AJ 


PM^  M^P 


Mj  PMjA  +  Cj 


(214) 


it  follows  that  the  trace  of  the  matrix  Aj»  defined  by: 

T  T 

KPM  M  PIT 

A.  * - * — sr - 

J  Mj  PMj  +  Cj 


(215) 


is  the  decrease  in  the  expected  squared  radial  miss  distance. 


An  attractive  measurement  selection  algorithm  might  therefore  be  based 
simply  on  calculating  the  trace  of  Aj  for  each  of  the  available  measure* 
ments,  and  selecting  for  further  processing  (i.e.,  processing  by  the 
Estimation  and  Control  Module)  that  measurement  which  yielded  the  largest 
trace  value. 


4.  MEASUREMENT  SPACE  AVERAGING 


Consider  a  set  of  available  (scalar)  measurement  differences  Yj  (J  «  l,2,...,n). 
Denote  the  corresponding  set  of  unit  line-of-sight  vectors  by  Tj  (J  •  1,2,..., 
n)*.  Then  the  space-averaged  measurement  on  this  set  is  defined  by: 


n 

Y  -  1/n  J3  r  Y 
j-1  J  J 


(2  lb) 


*  In  the  case  of  earth-mode  emitters,  replace  r 
glossary). 


by  t. 


(see  the  symbol 
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Define  the  error  in  by  fiY^ ,  and  that  portion  of  the  measurement  matrix 
associated  with  the  modeled  overall  system  errors  by  ftj.  Also  let  x  denote 
the  modeled  error  state  vector.  Then: 


li  ’  V + 


(217) 


where  6Y^  consists  in  all  the  unmodeled  measurement-difference  errors,  plus 
noise.  Using  equation  (217)  in  equation  (216)  leads  to: 

Y  «  Mx  +  5Y  (218) 


where: 


M  *  1/n 


(219) 


7  ■  l/n  JYj 


(220) 


Remembering  that  the  errors  dY^  are  assumed  to  be  unmodeled,  then  if  the 
scalar  measurements  Y  ^  were  processed  through  the  filter  sequentially  one 
at  a  time,  the  filter  would  essentially  correct  user  position  along  each 
line  of  sight  in  turn,  in  each  instance  with  an  error  essentially  equal  to 
r^  dY^.  These  errors  would  be  cumulative,  so  that  the  final  user  position 
error  dP_n  after  sequential,  one-at-a-time  processing  of  all  n  measurements 
Yj  would  be  given  by  the  expression; 


T, 

fiPSQ  "  fcrJ6YJ 


(221) 


On  the  other  hand,  use  of  the  space-averaged  measurement  defined  by  equation 
(216)  would  essentially  result  in  only  the  user  position  error; 


dY  ■  1/n  dPr 


(222) 


Thus,  dPCA  will  in  general  be  much  smaller  than  6P_n:  more  specifically, 

the  expected  value  of  dP_.  is  in  fact  n  times  smaller  than  that  of  dp_ 

SA  SQ . 
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APPENDIX  VIII 


RECURSION  EQUATIONS  FOR  MEASUREMENT 
TIME  SMOOTHING  AND  PREDICTION  MATRICES 


The  Phase  I  functional  formulation  of  the  Kalman  Filter  Module  provided 
closed-form  equations  for  generating  the  sets  of  matrices  associated  with 
both  the  measurement  averaging  and  the  estimate  and  covariance  matrix  pre¬ 
diction  operations.*  However,  since  in  many  practical  cases  it  may  be 
necessary  to  update  these  matrices  at  much  higher  rates  than  the  overall 
Kalman  Filter  Module  execution  rate,  recursive  rather  than  closed-iorm  formu¬ 
lations  are  preferable.  This  appendix  presents  and  discusses  an  appropriate 
set  of  such  recursive  formations.** 

The  matrices  (and  their  closed-form  expressions)  under  consideration 
here  are: 


1 

n 


Y 


i 


M  -  G 
i v  i .  F  r ,  i 


(223) 


(224) 


(225) 


(226) 


*See  Appendix  VII  of  this  (Phase  II)  report. 

*'vThe  derivati  ons,  whicn  in  many  cases  are  rather  lengthy,  art-  omitted  here 
for  brevity  and  clarity.  The  recursive  formulae  presented  here,  however, 
can  be  easily  verified  by  direct  substitution  of  the  closed-form  formulae. 


369 


(227) 


n 

*n.F"«2T  Ml*i,**P,i 

i-1 

n  n 

E  *  .FVij*  MJ.F 

i-1  j-1 

(Mi  F  "  Mi*i,F’  lJ  *  *  lar«er  of  1  and  J) 


(228) 


Note  that  formulae  (225)  through  (228)  represent  an  important 
generalization  of  the  corresponding  formula-  presented  in  the 
Phase  I  final  report,  which  are  valid  only  for  generating  a  new  Kalman 
estimate  of  the  system  error  state  for  the  time  at  which  the  last  measure¬ 
ment  Y  was  taken.  On  the  other  hand,  the  generalized  formulae  given  here 
n 

apply  in  the  more  general  case  when  a  delay  exists  between  the  time  of  the 
last  measurement  and  the  time  tp  associated  with  the  Kalman  estimate  (see 
the  time  sequence  sketch  below). 


Y,  Y,  Y, 


I — I — I — h 


H - 1 - h 


Cn  tn+l  tn+2 


*F  "  W 


|  Measurement  Averaging  Interval  -  * | 

•  Kalman  Filter  Cycle  Time 

The  recursive  formulations  of  the  t'osed-form  expressions  above  are: 


Wi  +  if*! -7i-i)  (v*  ‘-‘H 

V*i-l+i(Ci-®l-l)  (c0  -  o.  i  -  !  to  n) 


(229) 

(230) 
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V  ViVi.i  +I  (M1  •  V1V1.1)  (B0  •  °'  1  •  1  t0  ") 

*  ^n,n+i '-1  *n+i '-1  ,n+i'  (  Sn,n  ’  *•  *'  *  1  t0  "’) 


(231) 


m  -Me  _ 

n,F  n  n,F 


-  (l  -  l)  ("i-1  +  Ml-lGi-l,i)  (?o  •  °. 

/  J  (232) 

Gn*n+i '  =  Gn,n+i'-l  +  *n, n+i ' -lGn+i  ' - 1, n+i '  (Gn,n  °»  x'  “  1  to 


N  _  =  N  -MG  _ 
n,F  n  n  n, F 


zt  -  (*  - 1)  (\-Ai-i +  Mi-iRi,i-i)  ( zo  ■  °- 1  - 1  c° n) 

^n+i',n  ^n+i',n+i'-l  n+i '-ljn^n+i ' ,n+i'- I 

+  R  i  j  i  ...  i  (R  -  0,  i'  -  1  to  n'\ 
n+i  ,n+i'-l  I  n,n  I 

Z  „  ~  Z  +  M  _R_ 

n, F  n  F,n  n,F  F,n 

\  -  (‘  '  l)2  Vi  +  (\  '  7  Mi)  Vi-i  ("i  ’  7  Mi  )T 

|wo  =0,  i  «  1  to  nj 

W  -  W  +  M  pRr  MT  p 
;; , F  n  n,F  F,n  n,F 


(233) 


(234) 


Formulae  (229)  through  (234)  comprise  the  recursive  formulation  for  the  measure 
ment  averaging  matrices  defined  by  equations  (223)  through  (228).  The  corres¬ 
ponding  recursive  formulae  for  prediction  are: 


♦This  formula  is  for  recursive  generation  of  >*  _  for  use  in  the  li  _  formula. 

n, r  n, F 

'♦This  formula  is  for  recursive  generation  of  G  for  use  in  the  N  _  formula. 


♦♦♦This  formula  is  for  recursive  generation  of  R_  for  use  in  the  Z  and 
_  r,n  n,F 

and  W  _  formulae. 
n,F 
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t  *  i  .  ,  S.  .  +  G,  .  ,U 
i  *i,i-l  i-1  i,i-l 


(235) 


l  Pi  *  *i,i-lPi-l0i,i-l  +  Ri,i-1  J 

Use  of  the  above  recursive  formulae  (229)  through  (235)  requires  definition 
of  the  fundamental  incremental  matrices  ^  (and  n+i')*  Gt_i  i 

<a"d  Vl'-l.nM'5’  and  Ri,i-1  <and  Vl',n+i'-l)’  11  can  '*"°"a“a“d 


that* 


0i-1(i  *  I  +j  A(u)  tfju.tjdu 
Ci 

Gi-l,i  =  K-l  •  Ci)1+I  A(u)C(u.ti)du 

Ci 

Ri,i-1  =  (*i  -  ‘i-l )* 

t±  ) 

+  J  |A(u)R^u,ti_1)  +  RT(u,ti_1 jAT(u)|du 

If  the  time  interval  is  small,  then  these  formulae  can  be 

approximated  by: 


0i-l,i  *  1  '  Ai-l(Ci  "  Ci-l) 
Gi-l,i  *  'I(ti  '  Ci-l) 


Ri, i-l  K(ti  "  Ci-l)  'i  * 

0i, i-l  *  0i-l,i  ***  1  +  Ai-l(Ci  '  Ci-l) 

Gi, i-l  "  ”^i, i-lGi-l,i  81  I(ti  '  Ci-l) 

Ri-l,i  *  "0i,i-lRi,  i-lCi,i-l  81  _K(ti  "  i- 1 ) 


(i  ■  1  to  n  v 
and  ) 
i  »  1  to  n'/ 


(236) 


♦Again,  the  derivations  are  omitted  here  for  brevity,  but  the  formulae  can 
easily  be  verified  by  using  the  defining  integral  and  differential  equations 
for  ;,  G,  and  R. 
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APPENDIX  IX 


PROCESSOR  DESIGN  FOR 
NONLINEAR  LOS  PSEUDORANGING  SITUATIONS 


An  Important  multilateration  processor  design  problem  area  centers  on  the 
proper  use  of  available  radio  navigation  data  in  those  prospective  opera¬ 
tional  situations  where  the  user/emitter  relative  position  uncertainties 
are  comparable  in  size  to  the  actual  user/emitter  ranges  themselves.  The 
two  principal  such  situations  considered  here--both  against  the  background 
of  the  assumed  availability  of  a  net  of  LOS  radio  links  only--are 
(a)  navigation  start-up  (i.e.,  user  position  and  velocity  initialization) 
when  no  (or  only  coarse)  a  priori  position  and  velocity  estimates  are 
available,  and  (b)  transition  from  globally  referenced  (E  frame)  to  locally 
referenced  (EF  frame)  navigation  on  acquisition  of  an  objective  area  LOS 
net.  In  the  former  case  a  large  user  position  error,  and  in  the  latter 
case  both  a  large  user  position  error  (e.g.,  from  say  pure  inertial  enroute 
navigation)  and  a  large  emitter  net  position  error  (e.g.,  from  say  an 
objective  area  datum  plane  uncertainty)  are  present  which  may  well  be  com¬ 
parable  in  size  to  the  user/emitter  ranges  themselves. 

This  appendix  first  formulates  and  discusses  the  mathematical  basis  of  the  prob¬ 
lem,  and  then  outlines  some  promising  candidate  algorithms  for  its  solution. 


1.  GENERAL  DISCUSSION 

To  attack  the  problem,  consider  first  the  fundamental  ranging  equation,  which 
n  lates  the  primary  navigational  entities  involved  in  pseudoranging  --  which 
includes  two-way  ranging  as  a  subcase  --  between  the  user  and  the  jth  emitter 
( see  F igure  37) . 

! R j I  =  |p  -  Ejl*  (237) 

♦Throughout  these  notes,  the  symbols  P,  dr,  E ^  and  5E  can  everywhere  be 
replaced  with  p,  6p,  e^,  and  6*-*^ ,  respectively;  i.e.,  all  results  are  equally 
valid  for  either  E  or  EF  frame  referenced  computations. 
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r 


l 


A 


Figure  37.  User-Emitter  Geometry 


where  P,  E  ,  and  are  respectively  the  true  user  position  vector, 
the  true  jth  emitter  position  vector,  and  the  true  jth-emitter-to- 
user  range  vector.  The  left  side  of  equation  (237)  can  be  written: 


(238) 


where  R 


mj 


radio  pseudorange  (phase  of  user-received  emitter 
signal  relative  to  user  clock  phase  reference) 


difference  between  user  and  emitter  clock  phase 
references 


1 


1 

! 

1 

] 

I 

I 

] 

1 


6R  *  noise  in  R 
mNj  mj 


I 

1 

\ 
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Correspondingly,  the  right  side  of  equation  (237)  can  be  written: 

1  P-E.l  =  I  R.  -  6R.I 
J  J  J 

A  A  A 

where  R  =  P  -  E.,  6R,  =  6P  -  6E . ,  and  the  superior  hat  implies 
J  j  j  J 

the  estimated,  rather  than  the  true,  value  of  the  hatted  quantity. 
Equating  these  results  according  to  equation  (237)  gives: 


(239) 


R  .  -  6R  .  -  6R 
mj  mb  mNj 


I  Rj  -  6Rj| 


(240) 


Squaring  both  sides  of  equation  (240),  using  equation  (238),  and  collecting 
terms  leads  to  the  fundamental,  nonlinear,  pseudoranging  measurement/state 
relationship: 


YRj  -  v  +  vRJ  +Qf 


(241) 


where: 


T  r  T*  *  T  *  I  •  i 

x  *=  [  6P  '  6P  J  6R  .  J  6R  ' 

'  '  mb  '  mb' 

rAT  '  „  1  i  _  i 

mrj  '  [R«  s 0  i  !  0  : 

VRJ  -  -  (lRjl  +I6R„Ni)6 

YRj'l(iR/-Rlj) 


|  (6R  l  -  SR^  6R . 
2  mb  j  j 


i  .  T  ' 

:  : 

!  -art  : 
■  j  • 


I  >  T  1  T 


'•  0  '■ 
i  i 


A  A  A 

(RJ  =  PJ  '  EJ> 


(6P  =  5v) 


A  second  fundamental,  nonlinear,  pseudorange -rat ing  equation  is  obtained  by 
time  differentiating  (240),  multiplying  the  resulting  equation  by  (240) 
itself,  and  collecting  terms.  The  result  is. 


MRRjX  +  VRRj  +  QRRj 


(242) 
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where: 


xT  =  [6?j  6PT|  6Rn 

Vj  ■ 


1 

mb  | 

5R  ' 
mb  j  ; 

T  1 

6E  |  ... 

J  i 

...] 

i 

i  i 

*T.' 

AT' 

...] 

W)l 

— R  ,  J  • .  •  [ 
mJ!  ! 

-Rj ,  ... 

-Rji 

VRRj  VRj 

YRRj  =  YR.l  =  RjRJ  ‘  Rmj  Rmj 

*  \j  *  6Rmb  “mb  -  6RI  6R] 


AAA 

<RJ  ’  p)  -  V 


radio  pseudo  range  rate  (phase  rate  of  user-received  emitter 
signal  relative  to  user  clock  phase  reference) 

time  rate  of  change  of  6R  , 


Equations  (241)  and  (242)  are  the  fundamental  nonlinear  relations  between 
the  measurements  Y_,  (or  Y  ,)  and  the  error  state  x;  the  nonlinearities 
are  in  particular  grouped  in  the  term  QRj  (or  Q^j).  These  equations 
are  the  basis  for  the  development  of  several,  completely  linear  measurement/ 
state  relationships  in  what  follows. 


Before  proceeding,  it  should  first  be  noted  that  if  the  conditions 


(243) 


hold,  then  the  nonlinearities  in  equations  (241)  and  (242)  are  negligible, 
and  these  equations  then  reduce  to  the  linear  relationships: 
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YRJ  •  V  +  VRj 

Negligible 

Nonlinearities 

YRRj  =  MRRjX  +  VRRj 

One  emitter:  pseudo 
ranging  or  pseudo 
ranging  and  pseudo 
range  rating. 

(244) 

(245) 


Equations  (244)  and  (245)  are  equivalent  to  the  linear  measurement/state 
relationships  developed  in  the  first  phase  of  the  multilateration 
processor  development  effort,  and  which  are  derived  and  presented  in 
Appendix  VI  of  this  Phase  II  final  report. 

Those  equations,  like  (&)  and  above,  are  also  valid  only  when  the 
conditions  (2)  hold. 

Returning  now  to  the  consideration  of  the  basic  nonlinear  equations  (241) 

and  (242),  consider  first  the  case  when  two  or  more  emitters  are  j 

simultaneously  available.  It  is  evident  from  the  form  of  equation  (241) 

and  of  Q  ,  that  if: 

Kj 

6Ej  ■  6E,  or  6Ej  *  0  (246) 

then  writing  down  equation  (241)  for  emitters  j  and  k  and  differencing 
the  resulting  equations  leads  to  the  linear  form: 


4V  '  SMRjkx  +  4vRjk  P.eudo.Rans.lna.; 

two  or  more  emitters, 
condition  (10)  hold« 

where: 

AYRjk  "  YRj  '  YRk 

AMRjk  "  ‘  *Rk  Significant 

Nonlinearities 

A  v  *  v  -  v 

G  Rjk  Rj  Rk 


(247) 
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where  it  is  understood  that  the  set  of  variables  6Ej  in  x  has  been  collapsed 
to  either  the  single  common  (datum  plane)  error  vector  6E,  or  is  obviated 
entirely  if  6E^  =  0. 

Similarly,  if  (246)  holds,  the  same  procedure  with  equation  (242)  also  leads 


AYRRjk  ~  AMRRjkX  +  AvRR j  k 


where: 


Pseudo  ranging  and  (248) 

pseudo  range  rating; 


AYRRjk  YRRj  "  YRRk 


AMRR;k  =  “RRj  '  MRRk 


A  V  —  V  -  V 

a  RRjk  RRj  RRk 


Two  or  more  emitters; 
condition  (246)  holds 


Significant 

Nonlinearities 


Consider  next  the  case  where  only  one  emitter  is  available.  Under 
these  conditions,  dropping  the  unnecessary  emitter  subscript  j,  and 
introducing  instead  the  time  subscript  i,  equations  (5)  and  (S)  can 
be  written: 


YRi  =  ^1*1  +  VRi  +  QF 


(249) 


^RRi  “  MRRiX  +  VRRi  +  QRRi 


(250) 


Assume  now  that: 


6P  *  constant  (6R  *  constant) 

5E  ■  constant 

5R  .  ■  constant 
mb 


(251) 


Therefore: 


^Ri  -  1  5Rmbi  ’  5RI  6Ri 


Q__,  -  5R  .  5R  -  6R  5R. 
xRRi  mb  mbi  i 
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It  is  obvious  by  inspection  that  simple  differencing  of  equation  (249) 
[or  equation  (250)]  at  two  different  time  points  will  not  remove  these 
nonlinear  terms.  However,  given  the  assumptions  (251),  higher-order 
differencing  will.  To  this  end,  assume  that  some  linear  combination 
of  the  measurements 

the  measurements  Yj^  can  be  identified  such  that: 
nR 

LRQRi  =  2  WRiQRi  =  ° 
i-1 

Sl^RRi  *  ^  WRRiQRRi  =  ° 
i=l 


(252) 


(253) 


Y  aiU*  SOme  ^ot^er^  Hnear  combination  of 


where  w  and  w  are  the  weights  associated  with  the  linear  combina- 
R1  RRi 

tions  and  nD  and  n  are  the  required  number  of  measurements  which  must 
K  RR 

be  combined.  To  find  these,  note  that; 

p  2  2 

,R1-3[(,,*,‘V,iJ  ’  K  +  6R4‘J  ] 


1 

”  2 

[Kb. 

+  26R  , 
mb 

6Rmbn 

at  +  6r2, 

m  mb 

O 

- 

Kf' 

25RT6RAt.  - 
n  in 

MX.] 

(254) 

0r  QRi  ‘  I 

Kbn  ' 

K'2: 

>*C 

5R  .  6R  .  - 

mb  mbn 

6Rn6R)  4 ‘in 

1  /  •  2 
+  2  (6R„b 

1  *12 
-  1  6R  1 

> «!. 

(255) 

and 

^RRi  '  SRmb  (SR«bn  +  6Rnb4'in) 

“  <>RM  ■  Kb6R„bn  '  6R?  6Rn)  + 

where  At  *  t.  -  t  . 


•T 

6R  i 

(f>R 
\  n 

+  6RA‘J 

•  2 

1  • 

12  \ 

SR„b- 

1  6R 

1  )  &tin 

(256) 
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Si  ^Ri  and  Sir  ^RRi  therefore  ^ave  ^e  ^orm: 


"R  R  X  2 

SlQRi  =  ARlE  WRi  +  StfE  WRiAtin  +  AR3  WRiAtin 
i=l  i=l  i=l 

nRR  Sgp 

SlRQRRi  =  ARR1  ]C  WRRi  +  ARR2  2  WRRiAtin 


(257) 


(258) 


where  the  A  ' s  and  A  1 8  are  independent  of  the  summation  index  i.  Since 
R  RR 

these  are  arbitrary  coefficients,  QRi  and  Q  ^  can  be  zero  only  if: 


n  n  n 

>URl  ’>  "RiStln  "T  URiatl„  ■  ° 


(259) 


i«l  i*l 


ZVi  "Z  W'in  *  ° 


(260) 


To  simplify  these  conditions,  assume  that  the  measurements  are  equi- 
time-spaced,  ftt  apart.  Then,  since  At^n  *  (i-n)  At,  these  conditions 
reduce  to: 


"r  nR  "§ 

I“Ri  iURl  '2.  1(2n"°  "> 

i-l  i-1 


Z  RR1  z 


iw__ .  -  0 
RRi 


(261) 


(262) 


The  smallest  values  of  nR  and  n^  for  which  these  can  be  satisfied  arc 
nR  ■  3  and  n^  «  2.  Based  on  these  values,  the  resulting  weights  are: 


W  *  Jc 
RRI  RR 


“RR2  -2kRR 


w  *  W 
RR3  RR 
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where  kR  and  are  arbitrary  constants.  For  simplicity,  take 
*RR 


S  *  k~  ■ l- 


Next  note  that  x  ■  i  x  ,  where,  because  of  the  conditions  (251),  the 
l  l ,  n  n 

transition  matrix  $,  *  is  given  by: 

i,n 


i.n 


I 

1 

,(i 

-n)AtI  | 

0 

1  1 

I  0  1 

0 

1 

1 

0 

0 

^  1  ^ 

1 

7 

I  , 

0 

1  1 
.  0  . 

0 

1  ’ 

1 

0 

0 

1  " 

1 

i 

0  , 

1 

,  (i-n)At, 

0 

1^ 

1 

0 

0 

1 

1 

7 

0  ( 

0 

i  7 

.  1  . 

0 

1 

1 

0 

0 

1 

1 

7 

0  % 

0 

i  T 

.  0  i 

I 

!(i- 

n)AtI 

0 

1 

1 

7 

0  % 

0 

i  i 

.  0  . 

0 

1 

1 

I 

where 


T 

X  -  I 


T 1  *T 
6P1  J  6P 


SRmb !  6*J  6£li  5*t] 


Therefore,  equations  (249)  and  (250)  can  be  written:** 


(263) 


YRi  *  ^i  *l.nRXnR  +  VRi  +  QRi 

(264) 

RRi  "  ^RRi  #i,nRRXnRR  VRRi  QRRi 

(265) 

Operating  on  these  with  Lg  and  respectively  and  remembering  that 

hi  QRi  Sir  *  0»  one  can  write  the  desired  linear  measurement/ 
state  forms: 

4  /A  \  4 


2- 

i-l 

t 

I" 

i-l 


RiYRi 


w  M.,t,  .  1  X,  +  \  w„.v_  . 

Ri  Ri  i  ,4  /  4  Ri  Ri 

l 
3 


RRiYRRi 


XWRRiMRRi*i,3  J  x3  +  S  Wi 
,i-i  /  i-l 


'RRiVRRi 


(266) 

(267) 


*  I.e.,  for  transition  of  the  state  x  from  time  t  to  time  t.. 

n  i 

**This  result  tacitly  assumes  that  no  forcing  state  noise  of  consequence  acts 
on  x  in  the  time  period  of  interest  here. 
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These  can  be  finally  summarized  in  vector/matrix  form  as: 


hl^Ri  =  UR4X4  +  LR4VRi 

LRR3YRRi  *  ^RR3X3  +  LRR3VRRi 
where 


One  emitter; 

significant  nonlinearities; 
pseudo  ranging  or 
pseudo  ranging  and 
pseudo  range  rating 


LR4YRi  *  WR4SYR4S 

T 

YR4S 

Yn<)  Y  . 

R2  R3  R4 

T 

LRR3YRRi  *  WRR3SYRR3S 

T 

Y  * 

*RR3S 

[yrri 

Y  Y 

RR2  RR3 

LR4VRi  =  WR4SVR4S 

T 

VR4S  “ 

1  Vri 

VR2  ^3  VR4 

T 

LRR3VRRi  “  WRR3SVRR3S 

T 

VRR3S  * 

[VRRl 

VRR2  VRR3 

T  at 
lR4  "  WR4SR4S 


T  AT 
WRR3SR33' 


|3i~Ll3SR»3s|-“Ls4Is|  Mt“M3SR3S 


WT 

RR3S  3S 


-2wT  RT 
RR2SR2S 


-w  R 

RR3S  m3S 


T  i  T  4T'  T  at 

•  W  R  i  R*i  -uA  Ra 

RR3S  m3S  ;  RR3S  3'  RR3SK3S 


0  T  ! 

+  WRR2SRm2S  > 


I 

»  T  AT 

•  +2w  R 
1  *  RR2S*2S 


WR4S  "  ^  "3  3  1  '*  WRR3S  ^  ‘  2  I"'  WRR2S  l1  ’ 

A  rA  .A  ,A  ,A  .  A  -A.A.A.  A  PA  |A  - 

R4S  "  lR1|  R2!  R3!  R4^’  R3S  ■  tRl!  R2l  R3  ’  R2S  "  'Rl!  R2^ 


I  I  I 


Ri»s  "  ^Rml  Rm2  Rra3  Rm4' ’  Rm3S  "  ^Rml  Rm2  Rm3' 

A  r  A  !  A  ;  A  ,  A  .A  |  A  , 

R3S  "  'Rll  R2*  R3  ’  R2S  "  tRlJ  R2 

Rm3S  "  "RmiSl  Rm2Sl  Rm3S^’  Rm2S  "  ^Rmlsl  Rm2S^ 


2.  CANDIDATE  ALGORITHMS 


Depending  on  whether  only  one,  or  two  or  more  LOS  emitter  links  are  simul¬ 
taneously  available,  equations  (268),  (269),  or  (247),  (248)  respectively 
furnish  the  basis  for  any  of  a  wide  variety  of  types  of  linear  estimators  of 
the  error  state  x. 

For  example,  the  estimator  selected  could  be  of  the  closed  form,  batch 
type  on  the  one  hand,  or  of  the  recursive  (iterative)  form  on  the 
other.  Further,  it  might  either  be  of  the  least-squares  type,  or 
alternatively  of  the  statistical  (e.g.,  minimum  variance,  maximum 
likelihood,  etc.)  type. 

However,  the  fact  that  (recursive,  minimum  variance)  Kalman  filtering 
has  already  been  selected  in  Phase  I  as  the  best  technique  for  pro¬ 
cessing  the  standard,  linearized,  one-emitter-at-a-time,  LOS  measure¬ 
ments  [as  defined  in  AFAL-TR-72-80,  or  equivalently  by  equations  (244)  and 
(245)],  militates  for  the  selection  of  this  same  technique  for  processing 
the  special-case,  start-up  and  reference  frame  transition  measurements 
derived  in  equations  (268),  (269)  or  (247),  (248). 


Such  a  selection  ensures  maximum  compactness  and  efficiency  of  the 
overall  processor  program,  because  of  the  large  body  of  Kalman  Filter 
Module  subroutines  which  can  then  be  developed  and  used  in  common  for 
processing  the  standard  type,  and  the  special-case  types  (hereafter 
called  the  start-up  type)  of  measurement  alike.  In  fact,  the  only 
important  difference  associated  with  processing  these  two  different 
types  of  measurement  lies  in  the  Kalman  Filter  Measurement  Preprocessing 
Submodule,  where  in  start-up  situations,  measurements  and  measurement 
matrices  which  are  essentially  Just  simple  linear  combinations  of  the 
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standard  measurements  and  measurement  matrices  must  be  constructed 
for  use  by  the  Estimation  and  Control  Submodule.* 

With  this  approach,  the  appropriate  times  of  transition  between  use  of 
the  start-up  and  the  standard  types  of  measurement  might  be  specifiable 
by  means  of  a  simple  test  based  on  the  variance  levels  of  6R  end 
using  appropriate  elements  from  the  Kalman  Filter  covariance  matrix, 
as  follows. 


A  suitable  starting  point  for  defining  such  a  test  has  already  been 
identified  by  the  conditions  (243),  or  equivalently: 


1  6R  .1  <  k  | R  1 

(270a) 

jAmJ  (0  <  k  <  <  1) 

|6R  1  s  k  1  R  1** 

(270b) 

Squaring  gives: 

c  2  ,  2  2 

6R  ,  S  k  R 
mb  mj 

(271a) 

6RT6R  s  k2R^ 

(271b) 

Taking  expected  values  of  these  gives:*** 

.  2  2  2 

<CR  ,  >  £  k  R 
mb  mj 

(272a) 

<6RT‘R>  < 

(272b) 

*  It  is  pointed  out  that  although  the  1  inear -combination  start-up 
type  of  measurement  appears  at  first  sight  to  be  a  suitable  candidate  tor 
exclusive  use  all  the  time,  since  it  involves  no  measurement/state  non- 
linearities  at  all,  it  has  the  serious  disadvantage  of  requiring  the  simul¬ 
taneous  availability  of  data  fr«m  more  than  one  user/emitter  link  at  a  time. 
The  basic  linearised,  one-eraitter-at-a-t ime  type  of  measurement  is  there¬ 
fore  to  be  preferred  as  the  standard,  with  the  linear  combination  type 
reserved  for  the  nonlinear  s‘.art-up  situations. 

The  conditions  (246)  are  assumed, 

"he  right  sides  of  these  equations  are  treated  here  as  deterministic 
yjant i t  ies . 
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Equations  (272a  and  b)  represent  the  desired  tests  for  determining  Kalman 
filter  transition  to  and  from  start-up  and  standard  operation.  In 
particular,  start-up  operation  (i.e.,  exclusive  use  of  linear- 
combination  measurements)  should  be  initiated  and  should  continue 
(with  respect  to  a  given  net  of  emitters)  until  equations  (272)  are 
satisfied  for  every  emitter  j  in  the  net.  When  all  emitters  satisfy 
(272)  ,  then  standard  measurement  use  should  be  initiated.  In  imple¬ 
menting  the  tests,  the  right  sides  of  equations  (272a)  and  (272b)  should 

.  A 

be  computed  from  the  quantities  k,  R  .,  and  R  as  shown,  while  the 

mj  j 

left  sides  should  be  obtained  from  the  Kalman  filter  covariance  matrix 

P  as  follows.  P  can  be  written  in  partitioned  form  as.* 

K  K 


T  ' 

<6P5P  >  , 

i 

•  T  ' 

<6P6P  >  , 

• 

<6P6R  ,>  , 
mb 

i 

<6P6R  .  >  , 

mb 

T  1 

<6P6E  >  , 

I 

<6P6ET> 

.  x  ' 

<6P6P  >  , 

<6p6Pi>  , 

i 

<6P6R  L>  , 
mb 

<6  P6R  .  >  , 
mb 

.  x  1 

<6P6E  >  , 

, .  -x 

<6P6E  > 

<6R  5PT>  | 
mb  1 

i 

•  *P  1 

<6R  .  6P  >  , 
mb 

i 

2  ' 

<6R  .  >  , 

mb 

i 

•  1 

<6R  .  6R  .  >, 
mb  mb 

<6R  ,  6ET>, 
mb 

i 

<6R  5ET> 

mb 

•  T  1 

<6R  .  6Pa>  , 
mb  1 

i 

<5 ft  6PT>  J 
mb  1 

• 

•  * 
<6R  ,  6R  >. 
mb  mb 

■ 

<6“»b>  • 

1 

<6R  5  E  T> , 

mb 

i 

<6R  ,  5ET> 
mb 

T  ' 

<6E5P  >  , 

•  T  ' 

<6E5P  >  , 

<SE6R  .>  . 
mb  ' 

•  1 

^SESR  ,  >  , 
mb 

<6E5ET>  , 

<6E6ET> 

•  T  ' 

<6E6P  >  , 

•  -T  ' 

<6E6P  >  , 

<5E6R  .  >  , 
mb 

<6E6R  .  >  , 
mb 

.  x  1 

<6E6E  >  , 

<5E6ET> 

>  is  then  available  where  shown  in  P 


K  * 


*The  state  vector  x  and  covariance  matrix  P  represented  in  this  appendix  are 

K 

(for  brevity)  actually  only  the  subsets  of  elements  of  the  more  general  x  and 

P  (as  defined  in  AFAL-TR-72-80)  which  are  involved  in  the  measurement 
K 

operations  discussed  here.  Generalization  of  these  results  to  apply  to  the 
more  general  x  and  ?v  is  simply  a  matter  of  inserting  the  necessary  null 

lx 

relationships  between  the  measurements  defined  here  and  the  remaining, 
omitted  state  vector  elements,  and  then  reordering. 
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Since  <5RT6R>  *  <6PT6P  +  6ET6E  -  26PT6E>  -  <6PT6P>  +  <6ET6E>  -  2<6PT6E>, 

T 

it  follows  that  <6R  6R>  can  then  be  obtained  from  P  as: 

fv 

<6RT6R>  =  Tr  <6P6 PT>  +  Tr  <6E6ET>  -  2Tr  <6P6ET>  (274) 

where  the  symbol  Tr  denotes  the  trace  (i.e.,  the  sum  of  the  diagonal 
elements)  of  the  matrix  following  this  symbol. 

Finally,  the  constant  k  of  equations  (272)  should  be  chosen  small  com¬ 
pared  to  unity  (e.g.,  k  ■  0.1).  However,  simulation  may  be  necessary' 
to  determine  its  most  appropriate  handling. 


In  navigation  start-up  with  no  a  priori  position  or  velocity  infor- 
A  'N  A  A  A 

mation,  P,  P,  E,  E,  x,  and  PR  should  be  initialised  according  to 


A  A  A  A  z\  a  A 

a)  P=P  =  E  =  E  =  AR*  =  AR*  *  x  =  0; 


b)  <5P6PT>  =  <6E6E^>  »  <6P6ET>  *  a^I  (where  a  ■  large  (io)  position  error): 

P  P 

2  2*2  2 

<6Rmb>  =  aR’  <6Rmb>  *  °R  ^CR  *  0,577  x  lane  width,  dR  -  0.577  x 


groundspeed  capability  of  aircraft); 


c)  All  other  P  elements  »  0. 

I\ 


T  2 

On  the  other  hand,  in  E  to  EF  frame  transition,  <5E6E  >  *  a£I ,  where 

a  *  lc  emitter  net  datum  plane  error. 

E 


*  These  are  the  a  priori  estimates  of  phase  and  phase  rate  error  respectively 
which  are  subsequently  corrected  by  the  Kalman  filter,  and  should  not  be 
confused  with  the  corresponding  Kalman  filter  estimates  of  errors  in  phase 
and  phase  rate. 
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APPENDIX  X 


IMU  COARSE  SELF-LEVELING  AND  ALIGNMENT 


The  algorithms  developed  in  this  appendix  are  based  on  two  principal 
assumptions : 

(a)  The  carrier  vehicle  either  is  stationary  or  is  moving  at  constant 
speed  and  altitude  on  a  great  circle  course  throughout  the  entire 
coarse  leveling  and  alignment  operation.* 

(b)  Continuous  radio-autonomous  navigation  has  been  established  before 
the  start  of,  and  is  maintained  throughout  the  latter,  coarse  align 
phase.  Also,  the  fixed  transformation  TC^E  has  been  established 

To  begin,  if  v  is  the  vehicle  velocity  with  respect  to  the  earth  (E  frame), 
then  assumption  (a)  implies  that: 


i.e.,  the  time  rate  of  change  of  v  with  respect  to  the  local  vertical 
wander  azimuth  frame  L  is  zero.  It  follows  from  (275)  that;** 

(  -  -  8  -  (a»E/i  +  "i/e)  x  v  <”•>> 

Now  fACC>  the  accelerometer  output  vector,  is  a  direct  measure  of  the 
specific  force  f.  Neglecting  the  small  last  term,  (276)  can  therefore  be 
written: 


f*cc  “  ■* 


(277) 


♦These  conditions  need  not  and  cannot  be  exactly  satisfied;  however,  the 
inaccuracies  in  the  coarse  alignment  scheme  described  here  will  be  directly 
proportional  to  the  deviations  from  them. 

**See  Appendix  II,  equation  (46). 
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Since  -g  has  the  direction  of  the  local  (upward)  vertical,  it  follows  that 
if  is  the  unit  local  vertical  vector,  then: 

*1  “  £ACC/|  fACcl  <278> 


The  vector  provides  the  basis  for  platform  coarse  leveling.  In  particular: 


«  cos  8 


(pi)p  (*i) 

(»i)p  x  (2i)p  *  ("i)p  ”  5ln  9 
(-.)p  l* 


Wp 

^il 


(279) 


where 


the  unit  #1  P  frame  axis  vector 


!w:  ■ 


[  1  0  0]  J  and 


6  (0°  £  8  <  180°)  is  the  angle  between  the  platform  #1  (azimuth)  axis  and 
the  local  vertical.  The  vector  u^  lies  along  the  intersection  of  the  local 
horizon  plane  and  the  plane  defined  by  p^  and  p^,  and  has  a  magnitude  sin  8. 


A  very  fast  way  to  erect  the  platform  would  consist  in  applying  slew  rate 
along  the  platform  direction  defined  by  u. ;  i.e.; 

i  i  * 


(280) 


The  slew  should  be  continued  until: 

|„ll  «  «l  .ni  (*j)p  >  0 

where  6^  is  a  suitable  chosen  constant.* 


(281) 


However,  if  only  one  level  of  fixed  slew  rate  can  be  applied  to  each  platform 
gyro,  then  (280)  is  not  possible,  and  must  be  replaced  by: 


*  This  algorithm  will  probably  work  as  it  stands  even  when  the  platform 
is  initially  upside  down.  This  should  ,  however,  be  verified  by  simulation. 
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(“sLEw)p  “  I  “SLEW  I  (Pi)p 
until  |pj\p  |/^p  <  02  (i  -  2  or  3) 
and  then 

(,JJSLEw)p  "  l“sLEW^(Pj)p 

until  |ptJJ  p  <  82  <J\U 

where  @2  is  another  suitably  chosen  constant. 

When  coarse  erection  is  complete,  a  period  of  proportional  control  leveling 
should  follow  in  order  to  attain  a  sufficiently  accurate  platform  vertical 
to  allow  subsequent  coarse  alignment.  This  can  be  done  by  applying  the 
gyro  torquing  rate: 

(U,PROPl)p  "  kPROPL  (Uljp  (284^ 

where  kpROpL  ls  an  appropriate  proportional  leveling  control  gain.  In 
particular,  this  rate  should  be  maintained  until  the  end  of  coarse  alignment. 


(282) 


(283) 


When: 


(285) 


where  0^  is  an  appropriate  constant,  the  null  rate  applied  to  the  azimuth 
gyro*  should  be  replaced  by  the  azimuth  earth  rate  component: 


where  g£  is  available  as  a  dynamic  VSM  output. 


(28b) 


*  This  null  rate  is  implied  by  equation  10),  since  fuj]  is  a  3  X  l  vector 
whose  #1  element  is  zero.  '  ' 
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The  total  stabilisation  rate: 

(“Wjp  "  (“WjPLjp  +  ('“pROPlJp  <287) 

should  continue  to  be  applied  to  the  platform  gyros  until  coarse  align  is 
complete. 

With  the  platform  held  level  and  approximately  nonrotating  in  azimuth 
(with  respect  to  a  wander  aslmuth  frame)  by  the  torqulng  rate  (287) ,  the 
coarse  align  phase  can  begin. 


Since,  except  for  platform  drift  rates  and  the  azimuth  earth  rate  mis¬ 
alignment  produced  by  the  small  platform  hangoff,  the  applied  rate  (287)  is 
equal  to  the  sum  of  local  earth  rate  and  the  local  vertical  angular  rate, 
it  follows  that: 

(^yr)?  Tp/c(‘i»/i)c 

where: 

(“Wijc  "  (“fe/cjc  +  fvi)c 

Also: 

(fACc)p  83  "TP/C8C  (290) 


(288) 

(289) 


and  taking  the  vector  cross-product  of  equations  (288)  and  (290)  gives: 


(291) 


Equations  (288),  (290) ,  and  (291)  can  be  combined  into  a  single  3x3  matrix 
equation,  and  solved  explicitly  for  Tp^  as*: 


★An  alternate,  normalized  form  of  (292)  can  be  obtained  by  first  normalizing 
equations  (288),  (290)  and  (291).  This  fora  should  also  be  considered  when 
it  cases  to  actual  programming  for  a  specific  application. 
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-T 


i  *i  ■■  .  rw 


(292) 


TP/C  "  |(^ACc)pJ  (^YrIp  |  (fACc)p  X  KyrIp]  |_8C  j  (*Wl)c  ]  (^/l)c  X  8C 

In  equation  (292),  gc  and  are  available  directly  as  VSTM  outputs, 

(^/clc  can  a*80  comPuted  ^rom  VSTM  outputs  as  follows. 


Now: 


(^/cjc  "  Tc/p(ut»/c)i 


But,  if  L  is  any  locally  level,  wander  azimuth  frame,  then  because  of  assump¬ 
tion  (a)  above,  it  follows  that  u^c  -  o^c  Therefore: 


(“Wcjc  “  ^/pI^/cIp 

^ri/c) 

.(“i/C/L 


"  tc/ptp/l\tl/c/l 


In  the  L  frame,  however,  can  be  expressed  in  terms  of  vL  or  vc  as: 


(“1/c)l  *  f 


KLoVL  "  R  KLoTL/CvC 


where  R  is  the  nominal  radius  of  the  earth  and: 
o 


0  0  0 

0  0-1 
0  1  0 


~8l 

l®L| 


Therefore: 


(“Wcjc  *  R  (TC/L  KLoTL/c)VC 


or 


(“Wc/C  "  R  KCovC 
o 
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where: 


K  -  — -  x 

Co  igi 


l8l 


(c^/ c)c  can  therefore  be  determined  using  gc  end  v^  from  the  VSTM,  by  the 


formula: 


(“Wc)c  ■  r  jiy 


X  v_ 


(293) 


Equation  (292)  reflects  the  impossibility  of  stationary  gyrocompass ing  (i.e., 
azimuth  determination)  in  the  vicinity  of  the  earth's  poles  in  the  fact  that 
x  g  >  0  (since  and  g  are  parallel)  in  this  case,  so  that  the  indi¬ 


cated  matrix  inversion  required  to  determine  T^p  is  impossible.  Also,  if 


the  carrier  vehicle  is  moving  in  such  a  way  as  to  remain  essentially  non¬ 
rotating  with  respect  to  Inertial  space,  then  p  s=  0,  and  gyrocompass  ing 


is  again  impossible*. 


However,  for  all  other  types  of  vehicle  motion,  gyrocompass ing  is  possible. 

In  particular,  it  ij*  possible  for  a  moving  vehicle  at  the  pole,  provided  that 
sufficient  radio  data  is  available  to  continuously  maintain  accurate  VSTM 


p  and  v  outputs  during  the  align  phase. 

t  v 


When  only  an  AHRU  is  available  as  an  attitude  reference,  thf-i  Tp^  cannot  be 


initialized  directly  as  above.  Rather  and  Tp^  must  first  be  Initialized 

and  then  Tpyc  computed  from; 


TP/C  "  tp/ltl/c 


I 


^Mathematically,  this  condition  is  described  by:  vc  -  x  p^j, 

Strictly  speaking,  this  situation  can  only  arise  on  small-circle,  not  great- 
circle,  courses.  However,  it  can  be  closely  approached  at  the  high-latitude 
apogee  of  certain  great -circle  courses. 
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>  » •’ '7,»C#p*'r 


i 


1 


I 


I 


I 


\ 


1 


I 


1 


T Lyc  for  this  purpose  can  be  obtained  ai; 


rL/C  " 


-8C/UI 


L  \  fa/i)c  *  (Li)c 
(h)c  ■  (h)c  «  (h)c 


(unit  vertical  up) 


where  L^.L^  ■  unit  east,  north  vectors  if  v^  •  0 

-  unit  along-track,  cross-track  vectors  at  earth's  poles 

In  general,  if  L'  is  any  other  locally  level  frame  (i.e,,  such  that  L|  •  L,;) 
then  the  transformation  from  the  L  to  the  L'  frames  can  be  represented  by 


TL’/L 


1  0  0 
0  cob6L'/L  -,ln8L'/l 

o  .m  eLVL  co.  eL./L 


where  fa  the  CCW  angle  from  to  L3' 

If  L*  ■  local  up,  east,  north  frame,  then: 


where: 


,i0  ev/L  ’  (hfc  "c 

co*  ®L'/l  ’  Wc  *C 


e£  ■  unit  east  vector 


n^  «  unit  north  vector  ■ 


■(w)c* 


with  v^  set  to  zero 


x  t. 
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Near  the  poles,  where  L*  cannot  be  defined  In  this  way  since  north  is  undefined, 


^L'/L  can  be  by  £be  more  general  equations: 

Sln6L'/L  '  (L2^(L2c)' 
c0S  «LVL  ‘  (L2)?(L3c)' 

where {l«  jc  must  be  defined  with  respect  to  the  earth-fixed  C  frame,  and 

(L3c)'  '  (ll)c  X  (L2c)’ 


APPENDIX  XI 

ANTENNA  LEVER  ARM  ERRORS 


This  appendix  contains  the  development  for  establishing  the  errors  due 
to  uncertainty  in  aircraft  frame  direction  cosines  and  gives  a  means  of 
reducing  the  state  complexity  and  redundancy  contained  in  Appendix  VI. 

A  basic  linear  error  effect  is  the  uncertainty  in  defining  the  antenna 
lever  arm  of  the  user.  Note  that  the  error  vector  is  defined  by  assuming  the 
following  conditions: 


(a)  Antenna  separation  from  platform  is  fixed  and  invariant  in  the 
airframe  coordinate  system. 

(b)  A  direction  cosine  matrix  (DCM)  is  defined  which  transforms  from 
aircraft  coordinate  system  to  computer -defined  earth-centered  system. 


Notatlonally  the  lever  arm  is  defined  as: 

(j  m  T  *  d 
C  C/AA 


(294) 


where  dA  ■  antenna  lever  arm  in  aircraft  frame,  vector 
d^  •  antenna  lever  arm  in  computer  frame,  vector 

Tc^a  •  direction  cosine  matrix  (DCM)  from  aircraft  to  computer  axes. 

In  order  to  establish  the  error  vector  for  the  antenna  lever  arm, 
consider  the  following; 


CM  *  »TC/*|(d*  *  Ma) 


and 


d  ♦  bd  m  T 


d  +  Ad  .  Tc/AdA  ♦  Tc/AAdA  +  6Tc/AdA  +  6Tc/AAdA 
*d  *  WdA  +  6TC/A*dA  +  *TC/AdA 


(295) 
(29b) 
(  -97) 


where  6TC^A  •  3x3  direction  cosine  matrix  which  Is  functicr^l  with  TcyA 
and  with  the  errors  in  establishing  T^A 

AdA  •  error  in  antenna  lever  arm  as  defined  along  the  aircraft  axis. 


The  DCM  6T^A  Is  also  given  by: 


tc/a  *  6tc/a 


1  +  wc/ata/c  IItc/a 


(298) 
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where 


6tc/ata/c  ■  •k«w  symmetric  matrix  which  for  email  angle  errors  is 
the  vector  matrix  [$xj 


Wc/A  ■  [®3tc/a  • 


*  ^y 
~0Z  0 


i  $ 

L  y  * 


’X 

0 


C/A 


(299) 


The  proof  of  the  logic  given  for  defining  the  Incremental  Direction 
Cosine  Matrix  6TC/A  i»  given  by  the  following: 


Consider  the  DCM: 

T  +  6T 

Ue  can  write 


T  +  6T  -  I  +  6TT  T 


(300) 


since 

67TTT  -  6T[I] 

|  1 

T  +  6T  -  T  +  6T  |tTT| 

-  |l  +  [®x]|t 

(302) 

so 

[®xl  -  ATTT 

(303) 

:®x]T  -  6TTTT  -  6T  [I]  -  6T. 

(304) 

where 

L’tfx?  ■  skew  synsnetric  matrix. 

Note  that  the  formulation  of 


WC/A  " 


(305) 


requires  only  the  definition  of  a  skew  symmetric  matrix  of  3  unknown  vector 
misalignment  angles: 


t. 


rather  than  the  9  elements  of  6T 


C/A' 
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The  approach  defined  for  all  9  elements  is: 
Ad 


ITC/A  +  WC/A 


“A  +  WC/AdA 


Observable  portion 
of  any  error  of  [  Assume  -  0 
antenna  location 

* 

or  keep  in  state  vector 
for  the  filter  to  estimate. 

The  latter  portion  may  be  written  as: 

6T 


C/A 


0  0  -0 

z  y 

-0  0  0 

z 


T11  T12  T13 
T21  T22  T23 


[_*y  *x  0  J 

L 

T31  T32  T33 J 

T2lVT310y 

T22VT32*y 

ToV/  -T,/ 
23y  z  33  y 

-T.,0  +T,,4 
llvz  3l*x 

'T120z+T320x 

-T. ,0  +T^t0 
13wz  33*x 

T.  0  -Tn,t 
llvy  21  x 

T.,,0  -To-0 

12  y  22yx 

T. ^0  -T„-0 
13*  y  23*x 

«  3x3  = 

?12 

7>i3 

^2 1 

*22 

*23 

^31 

/* 

32 

0*k 

,  33 

and  6T, 


C/A 


h- 1 


[3x3] 


dA, 


dA, 


dA, 


+  *2*  12^A2  ^*13^^3 


<Z>2  ldAl  +  ®22dA2  +  ®23dA3 
^3l^Aj  ^32^2  ^  ^33dA3 


3x1  vector 


(307) 


(308) 


(309) 
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Expanding  the  terms  for  the  indicated  product  yields: 
Adl  =  (T210z  ‘  T310y)dAl 
(T220z  ‘  T32^y)dA2 
(T23^z  ‘  T33cSy)dA3 
Ad2  =  (’Tll#z  +  T31^x )dAl 
(‘T12fl6z  +  T32^x)dA2 
('T130z  +  T33^x)dA3 
Ad3  =  (T 1 l^y  •  T21^x)dAl 

(T12^y  ‘  T22^x)dA2 

(T13^y  "  T23^x)dA3 
What  is  wanted  is  the  following: 


K 

<h 

x 

CM 

TJ 

<3 

s 

M 

®v 

KJ 

The  elements  of  [m]  can  be  defined  as: 

M..  =  0.0 
il 

M22  -  0.0 
M33  =  0.0 


1 

J 

(310)  I 

I 

i 

(311) 

1 

I 

(312) 

I 

I 

(313) 

I 

I 

I 


(314) 


I 
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-  T*  ' 


1 

1 

1 


M12  *  *T31dAl  ‘  T32dA2  ‘  T33dA3 

*  -  |T31  T32  T33]  K 

1  dA2 

dA, 

p  ^ 

*  ^21dAl  ^22dA2  ^23dA3 


(315) 


(316) 


I 

I 

f 

I 


which  defines  rMj  to  be  a  skew  symmatr ic  matrix  with  6  nonzero  elements,  3  of 
which  are  identical  except  for  sign! 


i 

J 
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•i?  .  V  ^  -‘'.  V- 


i 


Note  that  each  element  of  M  is  basically  a  dot  product  of  two  vectors 
which  are: 


T 

and  =  ilumn  vector  of  T 

T 

T2  =  column  vector  of  T 

T 

=  column  vector  of  T 


and  M  = 

'  0 

-T3-dA 

T2-dA 

T3-dA 

0 

-T^dA 

-T2*dA 

T^dA 

0  . 

I  j  x2  |  I3]  (321) 

I  I 


(322) 


(323) 


i 

1 

I 

I 

1 

I 

1 


I 

1 

I 
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APPENDIX  XII 


LOS  RANGE  AND  RANGE  RATE  TIME  DELAYS 
PERTINENT  TO  MULTILATERATION 


This  appendix  is  concerned  with  the  mechanization  and  timing  sequence 
due  to  transit  and  computational  delays  for  a  pseudorange  and  range-rate 
system.  The  development  is  intended  to  answer  some  bothersome  aspects  of  the 
timing  and  control  sequence.  In  general,  this  appendix  can  also  be  con¬ 
sidered  in  part  an  extension  of  the  material  and  results  of  Appendix  VI. 


1.  PSEUDONOISE  RANGING  CONCEPTS  FOR  ERROR  ESTIMATION 

Consider  a  universal  time  track  defined  as  t  : 

o 


I _ time 

tQ  (•♦-user  begins 

— -|-* — satellite  begins 
Ti 

At  tQ+Tu  8  user  receiver  generates  a  pseudorandom  noise  phase-shift  keyed 

code  sequence  which  is  used  to  cross-correlate  with  a  signal  generated  by  the 
ith  satellite  which  also  generates  the  same  PRN  PSK  sequence,  but  with  a 
transmission  Incidence  of  starting  given  as  t  -fr^. 


Note  that  in  both  cases  the  universal  clock  delays  can  be  defined  as 
range  biases  given  by: 

b  ■  ct 

U  U  c  ■  speed  of  light 


In  the  same  universal  time  track  we  define  that  we  have  knowledge  of 
the  satellite  position  vector  or 

e^(t  )  «  known  satellite  position  vector 


Actually  all  we  will  have  in  reality  will  be  an  estimate  of  the  satellite 
vector  or 
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(324) 


e(to)  -  e(tQ)  +  Ad(to) 


The  position  of  the  user  is  given  by  a  p  vector  or 
p(to)  A  defined  user  position  at  tQ 


The  exact  range  between  the  user  and  the  satellite  is  defined  as  the 
scalar  quantity  (see  Figure  38). 


p-e 


(325) 


or 


lR<V 


lp(t0>  -  ®(t0) I 


Unit  Vector  Along  LOS 


Figure  38.  User-Receiver  Vector  Geometry 
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I 

I 

I 

1 

I 

I 


! 

i 

§ 


\ 

f 


It  is  this  range  which  causes  a  time  delay  of  the  code  sequence  measured 
at  the  receiver  so  that  the  receiver  cross-correlation  measures: 


lR<Co>  ^  +  AT,  +  AT  -  T  +  T.  + 


4  ■  AT. 
u  i  L 


where  AT,  «*  time  delay  through  receiver 
d 


AT  »  noise  in  measurement 


AT  *  link  delays  due  to  troposphere  and  ionosphere. 
Li 

This  measured  time  delay  is  scaled  into  range  by 

cT ,  *  I R(t  )|  +  CAT,  +  cAT  -  b  +  b.  +  cATt 
j  o  a  u  1  l 


(326) 


This  range  measurement  is  not  obtained  with  respect  to  universal  time  until 
t^  where  t^  is  the  sum  of  at  least  the  delay  time  | R( t q) |  plus  a  processing 

delay  tp.  c 


|R<Co> 


formulate  computer  estimate  of 
LOS  scalar 


Assume  that  at  time  tj  in  the  receiver-computer,  which  is  t^-T^,  the 
receiver  transfers  the  measurement  to  the  computer  and  the  computer  forms 


the  following  estimate  of  scalar  LOS  range; 

Ntj')  +  AR(tj')|  -  |p(tj  ')  -  e(tj ')  | 


(327) 


where  p(t^’)  »  p(tj')  +  Ap(tj')  (true  user  position  plus  error) 

e(tj)  ■  e(tj')  +  Ae(tj')  (true  emitter  position  plus  error) 

but  p(tj')  -  p(tQ)  +  p(tQ)  (tj'-to)* 

and  Ap(tj')  »  Ap(tQ)  +  Ap(tQ)  (t ^ ' -tQ) 


*This  is  of  course  an  approximation,  since  acceleration  and  higher  order  terms 
have  been  neglected. 


! 
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So 


P(tj')  -  P(t0)  +  P(t0)  <t,  -  Tu  -  to) 

and  similarly  for  emitter  position.  But  we  know  t ^ -tQ  “  Tj  +  cp5  thus  the 
term  provided  by  the  computer  will  be: 

|p(t„)  +  t(t0)  (Tj  +  tp  -  Tu)  -  .(t0)  -  t(to)  (Tj  +  tp  -  Tu)| 

+  UpO^  +  6p(tc)  (Tj  +  cp  -  Tu)  -  4e(t0>  -  +  tp  -  Tu)| 

The  observable  provided  to  the  Kalman  filter  will  be  the  following 
difference: 

Y  ■  observable  error 

Y  -  | R( t j ')  +  AR(tj')|  -  cTj  (328) 

Let  r  *  unit  vector  defined  as  _R_  along  the  LOS;  then  we  may  write  the  above 

lRl 

equation  as  the  following  dot  or  transpose  product; 

Y  -  rTp  (tQ)  +  rTp(to)(Tj  +  tp  - 

-rTe(t0)  -  rT4(to)(Tj  ♦  tp  - 
+rTAp(tQ)  +  rTAp(to)(T.  +  tp  -  rj 
-rTAe(to)  -  tTA4(to)(TJ  +  tp  -  tu) 

*rTp(to)  +  rTe(to)  -  cATd  -  c6T  +  bu  -  b£  -  cATL  (329) 

Canceling  out  the  conraon  terms  of  the  above,  we  obtain: 

Y  *  function  of  error  states  (Ap,  Ae,  Ap,  Ae) 

+  function  of  timing  error  (bu,  b^,  cAt^,  cAt^) 

+  measurement  noise  (c6T) 

If  we  define  the  state  vector  for  our  system  as  the  following  n  element 
vector,  the  entire  observable  equation  may  be  expressed  as: 

Y  -  Mx  +  v  (330) 
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where 


x  -  Up 


Substituting  for  Tj,  we  obtain: 


r  r1 

(T,  +  t  -  t  )  «  — -p(t)  -  —  e(T  )  +  AT.  +  t  -  2t  +  t  +  AT. 
'  j  p  u  c  o'  c  '  o'  d  p  u  i  L 


^random  measurement  noise 


So  rTp(tQ)  +  rTAp(tQ)  -  rTp(tQ) 

and  r*e(t  )  +  r^Ae(t  )  ■  r^e(t  ) 
o'  o'  'o' 

v  ■  -c6T 


values  of  estimated 
velocity,  uncontrolled 


Examination  of  equation  (329)  indicates  that  using  nonsynchronous  data 
differences  leads  to  the  additional  terras  in  the  measurement  (relative  to 
those  required  for  synchronous  differences;  see  Appendix  VI): 


AY  -  rTMT.  +  t  -  t  )  -  rTe  (T,  +  t  -  t  ) 
r  J  p  u'  j  p  u' 


(331) 


These  terms  can  be  compensated,  since  we  do  indeed  have  knowledge  of 
p(tj’)  and  !(tj)  and  Tj.  Therefore  a  compensating  AY  can  be  generated  such 
that: 


4?  -  -  rT!(tj'  -  Tj)  JTjI 
+  rT4(tj'  -  Tj)  |Tj| 


(332) 
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Such  a  mechanisation  would  require  a  backward  propagation  in  time  to 
the  approximate  time  t'o  which  is  in  error  from  true  time,  tQ,  by  (tp-Tu). 


It  would  also  of  course  be  possible  to  compensate  the  measured  time 
delay  tj  itself,  instead  of  the  range,  to  obtain  the  approximate  delay  time, 
but  this  is  conceptually  the  same  as  the  above  and  hence  should  make  no 
difference  in  terms  of  the  error  coupling.  The  observable  &Y  can  be  written 
after  compensation  as: 

«  ■  ['V.)  -  *TPtt0’>]  [*jj 

+rTP(to>  ['p  •  Tu] 

-[rTi(to)  -  rT;(t0')][Tj| 


(333) 


At  first  glance  this  may  not  appear  to  be  much  of  a  simplification,  but 
if  we  assume  that  the  acceleration  is  small  or  zero,  then: 

UY  =  rTp<to)  [tp  .  tu  j 

'  rTi(to>  [‘p  '  Tu|  <334> 

Hence  the  terms  of  the  observable  with  velocity  compensation  are: 

Y  -  tTlp(-o)  -  rTie(to)  +  rTp(to)tp  .  tT4(to)tp 

T  •  T  • 

•  C  p(to)  -  cJtu+  r  e(to)Tu 

*  cATd  *  ^tl  •  CTi 

+  ctt  (335) 

T 

Let  M  »  transpose  of  the  measurement  matrix;  then: 
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t 


I 

I 

I 

I 

I 

i 


0 

-rT 

0 

T  e  T» 

1  -  r^t^  +  rxe(to) 
c  c 

-  1 
-  1 

T*  T. 

rTp(tQ)  -  rTe(to) 

-1 


(336) 


Note  that  since  the  propagation-delay -dependent  elements  of  M  involve 
a  division  by  the  speed  of  light,  these  are  extremely  small  terms.  Hence, 
with  a  velocity-compensated  mechanization  which  has  no  fixed  processing  delay 
time,  tp,  the  measurement  matrix  reduces  to  that  for  the  short-range  LOS 

case  of  synchronous,  almost  instantaneous  (because  short-range)  propagation. 

Table  LXXXIV  summarizes,  for  convenience  of  reference,  the  event  timing 
involved  in  the  foregoing  discussion. 


1 


TABLE  LXXXIV.  SIM4ARY  OF  EVENT  TIMING 


Universal 

Time 

Index 


|  user  clock  delay  with  respect  to  universal  time 

T 

U 

|  satellite  clock  delay  with  respect  to  universal  time 


- T j  .  » \  measured  delay  time  for  range  correlation 

1^__J  processing  delay  for  measurement 
t 

P  . 

I  data  transferred  to  computer 
|  t  T.  |  transition  back  to  approximate  tQ 

t  J  approximate  zero  time  using  user  clock 


I 

I 
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2.  OBSERVATION  OF  PSEUDORANGE  RATE  FOR  ERROR  ESTIMATION 


For  moving  vehicles  the  measurement  of  the  doppler  shift  frequency  of  the 
carrier  is  given  by 


f  2  v»R 

°'r|R| 

•  • 

where  v  «  p-e 

R  ■  p-e 

\  =*  carrier  frequency. 

Given  that  the  user  and  satellite  clocks  are  varying  with  rates  of 
• 

b  ■  user  oscillator  rate  in  fpa 
u 

e 

b.  »  satellite  oscillator  rate  in  fps 


(337) 


the  measured  doppler  term  or  pseudorange  rate  ia  thus  given  as: 


v.R 


+  by  +  b^  +  AL 


(338) 


where  AL  «  transmission  link  range  rate. 


Realistically  any  doppler  measurement  requires  a  finite  amount  of  time 
to  obtain  the  frequency  measurement  so  that  equation  (338)  becomes 


HI 


D(tn-1>  A  /%( t)  •  •  ; 

2  J  - - dt  +  J  J  V  'dt  +  bu  +  bt  +  A 

Cn-1  Cn-1 


AL  (339) 


where  f^(t)  ■  derivative  of  doppler  shift 

At  -  measurement  interval  »  t  -  t  , 

n  n  -  i 


Since  timing  is  defined  by  the  user  clock,  the  actual  universal  time 

definition  is  related  to  the  above  by  (t-T  )  where  T  ■  propagation  delay 

♦i  n 

time.  Note  also  that  the  interval  At  has  a  timing  error  which  is  due  to  the 
user  clock  rate: 


At'  -  At 


c 


(340) 
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In  summary,  any  data  measured  at  the  receiver  is  delayed  by  the  propaga¬ 
tion  time,  and  the  data  is  averaged  over  an  incorrect  time  interval  due  to 
the  clock  drift  rate. 


The  nature  of  the  frequency  shift  derivative  can  be  formulated  by  the 
following: 


3t<V 


d_ 

dt 


J  tv.RXlRlr1 

rwr1  +  [..RK-inwr2  JjC|r|i 

jL  LcSl .  {  l  n»u 

M3*  |r|  d  de  |r| 


37-(R)  ♦  M-lr  •  »n  it  1*13 


dR 


2 

a|r| 


(341) 


Hence  the  derivative  consists  of  three  terms:  two  dot  products  and  a 
derivative  of  the  scalar  range.  These  three  parts  of  the  derivative  may  be 
written  an; 


d  ..  .  2 

Jt(fD>  ■  X 


+  x 

-  f. 


dv.  R 

dt  1*1 

v  .  dR 
dt 


1*1 


R  55 
R*dt 


(342) 


Obviously  if  the  quantities  v(t)  and  R(t)  have  significant  time  variations 
during  the  interval  At,  the  formulation  of  f&|(t)  could  be  rather  complex. 
Therefore  assume  for  the  moment  that  At  is  sufficiently  small  so  that  equation 
(337)  describes  the  range  rate  scalar  relation  defined  within  the  computer; 
hence  at  time  t  the  following  values  are  generated: 


v(t B)  ■  p(tn)  - 

•  *<'«>  •  •«»>  ) 


estimates  of  velocity 
<^nd  posit  ion 
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The  velocity  and  position  estimates  may  be  written  as: 

'('J  ■  +  <*«„>  -  *<■*>  - 

R(tm)  “  P(tm)  +  Ap^  ‘  "  Ae<cm) 

Using  the  results  of  equation  (341) ,  we  may  write  the  error  in  f^,  the 
doppler  frequency,  as; 

**»  ■  ^f(4#krl 


+  2  (p>e).(Ap-Ae) 

!  (lp-®l) 


-e) *(£p -L 


(Ip-eljf 


Or,  using  the  unit  LCS  direction  cosine  vector  r. 


AfD  -  y  (Ap-Ae)rT  | 

J 

+ 1 

x  IrI 


[(AP-Ae)rT] 


(344) 


The  last  two  terms  here  can  be  written: 


2  (p-e)  (Ap-A< 

£  I » l 


1 

-  r  (6p-6e)rC 

IrI 


i  fii^T|,  .  rtT| 

A  '  'J 


(Ap-Ae) 


(345) 


With  this  simplified  form  we  now  have  a  means  of  expressing  measured 
observables  of  data  as  the  difference  between  the  computed  range  rate  and  the 
measured  range  rate. 
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Let  Y  “  observable  for  the  filter;  then: 


2  I  T  •  •  T 

Y  *  j-  (p-e)r  +  (Ap-Ae)r1 


R 


I  -  rr 
<t  i) 


(Ap-Ae) 


/•Cn  r  ^n-l'dt  n  ,  ^ 

-  J  fD~At -  -/  fD(t)dt  • 

Cn-1  n-1 


.  9  *2  *  2  ( 

x  •  bt  x  '  y 


In  order  to  understand  the  time  span  for  the  above,  consider  that  the 
universal  time  axis  is  given  as: 


t  .  -T 
.n-1  n 

*—  I 


t  -T 

c n 


'n-1 


m 


computer  formulates  estimated 
radial  rate  and  makes  comparison 


For  the  sake  of  brevity  and  further  understanding,  consider  that 


2 

A 


(P(0  -e(t  ) 
m  m 


t  h  f_<t  ,) 

r  -  I  _D_  n- V 


t  .  At 
n-1 


(t)dt 


is  most  likely  nonzero  and 
•  2 

where  AB  *  dynamic  doppler  lag  due  to  nonsynchronous  sampling 
and  finite  doppler  bandwidth  and  delay. 


And  thus  in  velocity  terms: 
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Y  -  AP(tm)  -  Ae(tm)  r 


{p(t  )  -  e(t  )]  T  T1 

•  1  m'  v VJ  i  .  rrT  Ap(t  ) 

I  J  m 


*  Ae(tm> 

tn 


-  b  -  b.  -  AL  +  AB 
u  i 


(3A7) 


Note  that  all  the  above  terms  are  given  for  the  time  t  *  t 


The  next  consideration  is  the  possible  differentiation  between  the  link 
velocity  error  and  the  velocity  lag  error  due  to  functional  effects. 

Let  us  first  examine  the  link  transmission  error  effects.  From  basic 
theory  it  is  known  that  the  phase  length  path  due  to  the  ionosphere  is 
reduced  by  an  amount  identical  to  the  group  path  energy  delay. 

The  phase  length  decrease  relative  to  free  space  is  given  as: 


E 


N(s)ds  • 


(348) 


If  the  line  integral  which  defines  the  total  electron  content  along  the 
LOS  is  time-varying  as  it  would  be  due  to  relative  motion  of  the  LOS,  the  rate 
of  change  of  the  integral  will  result  in  a  frequency  shift  of 


a 

-K  2tt  id  f  .  . 

M  ■  7  •  x  -?r  dt  J N(s)<ls 

s 

'  if  Jt  /"COds 


(349) 


In  order  to  determine  the  magnitude  of  the  doppler  shift  due  to  ionosphere 
changes,  we  need  to  make  two  basic  dynamic  considerations: 

(1)  What  is  the  angular  change  of  the  LOS  for  a  constant  homogeneous 
density  atmosphere? 

(2)  What  is  the  time  variation  for  a  true  horizontal  gradient  in  the 
vertical  electron  content? 

Consider  the  evaluation  by  means  of  the  following: 


[N(s)ds  =  Iy  CSC  0f 


(350) 
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where 


2 

I  =  vertical  electron  content/m 
v 


CSC  0  =  geometric  obliquity  factor. 

K 


The  time  derivative  of  the  above  integral  may  be  denoted  as: 
!/»«<”  .3^  CSC  8R  +  iv  i  CSC  eR 


(351) 


The  rate  of  change  of  I  with  time  can  be  established  by  letting  the 

horizontal  gradient  be  given  as: 
dl 


dx 


*  17.  per  100  miles 

17  -2  2 

=10  x  0.01  x  10  electrons/m  /mile 

13  2 

=  10  electrons/m  /mile 


Next  consider  that  the  maximum  relative  velocity  is  given  as  about 
4000  ft/sec  so  that  the  rate  with  respect  to  time  is; 


(352) 


dl 


13 

10  electrons  .  4000  ft  #  1 

2  6000  ft  sec 


=  0.7  x  10 


13  electrons  1 


T 


m 


sec 


(353) 


The  second  portion  of  the  rate  dynamics  is  given  as: 

d  d0R 

Xv  dtCSC  ®R  •  Xv  COt  ®R  CSC  ®R  dF 


(334) 


Geometrically  the  angular  rate  for  the  LOS  is  defined  as: 
d0r 


UJ 


'R  v  x  R 


dt 


|r| 


(355) 
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*# 
;5 
££  . 


Assuming  that  the  range  and  velocity  vectors  are  orthogonal  and  that 


v  =  4000  ft/sec 
max 


R  ,  ="  20,000  miles 

min  * 

the  angular  rate  is  given  as: 


-4 

v  4000  ft/sec  1  10  rad 

W  =  R  =  20000  x  6000  ft  "  5  x  6000  3  sec 


(356) 


The  rate  change  is  maximum  at  elevation  angles  near  the  horizon  and  we 
can  evaluate  the  function  at  a  low  elevation  angle  of  10  degrees,  so: 


Iv(5.6)(5.8)  ~ 

i  do'3) 

v 


,14  electrons  1 


(357) 


We  may  thus  establish  that  both  effects  (even  with  an  order  of  magnitude 
increase  in  the  horizontal  gradient)  place  a  bound  of  about 

m-4  io14 

cl 


where 


K  =  132  and  Af  ■  cps  (Hz) 


At  "L"  band  frequency  for  a  generic  621B  system,  this  becomes: 

132  1014 

Af  *  - 7 -  *  - 7 - 

983  x  10  ft/sec  1575  x  10  Hz 


132  x  10 
1550  x  10 1 


=  0.85  x  10  Hz 


(358) 


This  also  converts  to 


c  983  -2  —  -2 

x  0.85  x  10  -  0.5  x  10  ft/sec 


5. 


(359) 


The  results  --  for  changes  in  the  angular  LOS  and  for  horizontal 
gradients  --  indicate  that,  at  L  band,  extremely  negligible  velocity  errors  . 
will  be  introduced  into  the  system. 

Note  also  that  higher-order  ionospheric  error  terms  are  also  negligible 
because  they  depend  on  reciprocal  powers  of  frequency  and  with  smaller 
coefficients  than  the  first-order  term  evaluated  above. 

It  is  therefore  concluded  that:  An  ionospheric  velocity  error  state  is 
so  small  as  to  be  unobservable  with  respect  to  the  finite  lag  and  bandwidth 
effects  normally  encountered.  The  dynamic  doppler  lag  effect  is  by  far  the 
most  significant  error  term. 


APPENDIX  XIII 


PROPAGATION  DELAY  COMPENSATION 


The  effect  of  the  earth's  atmosphere  produces  both  a  curvature  In  the 
propagation  path  and  a  decrease  in  propagation  velocity  along  this  path  as  well, 
so  that  line-of-sight  range  measurements  are  significantly  greater  than  the 
true  geometric  range  between  the  emitter  and  the  transmitter.  These  effects, 
and  compensation  algorithms  for  them,  are  discussed  in  this  appendix. 


1 .  OVERALL  RANGE  ERROR  COMPENSATION 


The  range  error  compensation  can  be  developed  by  considering  the  geometry 
shown  in  Figure  39.  The  apparent  range  which  is  measured  along  the  curved 
line-of-sight  is  given  as: 


(360) 


where 


Re  ■  apparent  range 


n  *  atmospheric  radio  refraction  index 

R  *  ray  path 


_  y; 


The  apparent  range  is  a  line  integral  along  the  ray  path  which  has  a  non- 
unity  index,  since  its  is  generally  slightly  greater  than  1.0.  The  range 
increment  can  be  alternately  defined  in  terms  of  altitude  by  considering  a 
.small  spherical  shell  of  height  dh.  Using  differential  geometry: 


dR 


dh  CSC  e 


Equation  (360)  can  be  written  as; 


Re 


n(h)  CSC  6(h)  dh 


(361) 


where  n(h)  «  functional  variation  of  refractive  index  with  altitude 

B(h)  ■  variation  of  elevation  angle  with  altitude. 
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Tangent  to  Path  at 


Figure  39.  Propagation  Geometry 


Since  the  variation  of  n  from  unity  is  very  small,  another  term  is  defined 
which  represents  the  small  portion  which  differs  from  one  or: 


where 

and 


N  =  (n-1)  x  10° 

N  =  refractivity 
n  =  1+NxlO^ 


(362) 


Using  equation  (362)  leads  to: 
•h 

l 

Re 


•/ 

.'h. 


2  3 

CSC  0(h)  dh  +  10  N(h)  CSC  0(h)  dh 

Jh, 


(363) 


as : 


1  "  "1 
Since  the  geometric  range  is  given  as  D,  the  range  error  may  be  defined 

AR  =  Re  -  D 
■h 


AR 


r 1 

.L 


2  -6  f  h2 

CSC  0(h)  dh  -  D  +  10  /  N(h)  CSC  0(h)  dh 

•'t. 


‘1 


‘1 


curved  path  diff. 
AR. 


(364) 


g 


velocity  diff. 

arn 


Equation  (364)  contains  two  distinct  error  terms;  the  first  is  the  range 
error  due  to  bending,  AR^,  and  the  Eecond  is  due  to  velocity  decreases, 

Generally  the  bending  error,  ARgI  is  an  order  of  magnitude  smaller  than  AR^, 

and  a  direct  closed-form  compensation  for  it  is  therefore  not  contemplated. 

The  bending  error  is  thus  a  residual  error  effect  term  which  must  be  considered 
in  designing  the  Kalman  filter  for  lumped,  residual  propagation  error 
est imation. 


2.  BENDING  ERROR  COMPENSATION 

In  this  connection,  the  functional  form  of  the  bending  error  is  of 
interest,  and  this  may  be  determined  by  examining  empirical  data  for  the  error 

effect.  Magnitudes  of  bending  error,  AR  ,  are  shown  in  Figure  40  and  in 

g 

Table  LXXXV,  as  obtained  from  references  1  and  2. 


m. 


o  0.1  0.2  0.3  0.40.5  0.7 


1.5  2  2.5  3  4  5  7  10  15  20 


Apparent  Elevation  Angle  0 

Figure  40.  Errors  in  Apparent  and  True  Range  due  to  the  Troposphere 
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TABLE  LXXXV.  TYPICAL  AND  EXTREME  VALUES  OF  RANGE  ERRORS  FOR  TARGETS 
BEYOND  THE  ATMOSPHERE 


Typical  N£-320 

Extreme  Nf*400 

Maximum 

percent 

*0 

AR 

g 

arn 

ARe 

AR 

g 

arn 

ARe 

AR  /AR 
g  e 

0 

meters 

10 

100 

110 

60 

165 

225 

27 

20  mrad 

2.5 

62.5 

65 

4.5 

73 

77.5 

6 

50  mrad 

0.7 

38.1 

38.8 

1.0 

43 

44 

2.3 

100  mrad 

0.14 

22.26 

22.4 

0.2 

24.8 

25 

0.8 

200  mrad 

0.02 

11.9 

11.9 

0.03 

13. ,0 

13.0 

0.23 

500  mrad 

0.001 

5.01 

5.01 

0.002 

5.50 

5.50 

0.04 

The  information  from  these  two  sources  is  for  range  to  a  stationary  sat¬ 
ellite  and  the  data  is  replotted  in  Figure  41,  along  with  a  proposed  functional 
curve  fit  to  the  data. 

The  functional  curve  fit  is  chosen  by  assuming  the  following  form: 


ARg  ■  K  CSC  ^A2  +  0Q2  (365) 

where  K  *  constant  determined  by  error  at  zero  elevation  angle 

A  «  constant  which  establishes  the  slope  of  the  error  function. 

From  the  empirical  data  the  typical  values  of  the  constants  are  defined 
as; 


K 

A 


0.09 

0.3° 


AR  in  meters 

g 


For  apparent  elevation  angles  of  0Q s  3  degrees,  the  bending  error  is  a 

finite  value  and  should  be  considered.  The  only  difficulty  with  using  equa¬ 
tion  (365)  is  that  knowledge  of  the  apparent  elevation  angle  will  be  in  error. 
From  data  given  by  reference  2,  the  error  in  geometric  and  apparent  elevation 
angles  is  defined  as: 

f  -  %  ~  P  (366) 

where  P  ■  geometric  LOS  angle. 

For  typical  atmospheric  conditions  the  following  maximum  angular  error 
can  be  encountered: 

8^  *  0°  t  ■  .Taxiraum  of  20  mrad 

0 

0Q  ■  3°  f  ■  maximum  of  10  mrad 
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Figure  41.  Bending  Error  Data  Fitting 


Use  of  6q-0  in  the  residual  error  equation  leads  to  a  negative  angular 

error  of  0.5  to  1.0  degree.  For  this  low  elevation  angle  condition,  the  best 
option  is  to  initialize  the  value  of  equation  (365)  at  its  maximum  (0q  *  0°) 
and  to  utilize  the  pessimistic  error  state  condition. 

Note  that  the  angular  error,  £,  is  bounded  by  the  total  angular  bending 
angle  as: 

-L  <  £  <  T 
2 

where  t -  angular  bending  angle,  and  that  expressions  exist  for  £  as  a  function 
of  t,  the  surface  refraction,  refraction  profile,  and  apparent  elevation  angle. 


3.  VELOCITY  VARIATION  COMPENSATION 


Returning  now  to  the  more  important  velocity-variation  error  effect,  the 
principal  mechanism  involved  here  is  the  increase  in  the  energy  path  length 
relative  to  the  free  space  line  of  sight  which  is  caused  by  the  ionized 
electrons  along  the  path. 


The  group  path  range  increase  is  given  by: 


AR 


(u  -  1)  ds 


where 


u  ■  group  refractive  index 
S  ■  ray  path 


(367) 


The  group  refractive  index  can  be  approximated  by  the  reciprocal  of  the 
true  index  of  refraction,  so 


u 


1 

n 


•  • 


(u  -  1) 


(1  -  n)  since  n  y  1. 


AR 


(1  -  n)  ds 


ds 


(368) 


'-.22 


where  An 


mm 


■  1 

ur 

3 

N  -  number  density  of  free  electrons,  electrons  per  meter 

W  ■  angular  frequency  of  incident  wave 

3 

b  ■  constant  *  « -  ■  1.6  x  10  (MKS) 

l  €  m 
o 

0 

where  —  -  charge  to  mass  ratio  of  electron  €  *  free  space  permitivity 

m  o 

With  a  little  conversion  work  the  path  length  increase  can  be  written 


as: 

AR 

where  AR 

K 

f 

N(s) 


N(s)  ds 


meters 


(369) 


40.3 

frequency  in  Hz 

3 

density  function  along  the  ray  path  given  as  electrons/meter  . 


Equation  (369)  shows  the  basic  area  of  uncertainty  in  predicting  the  path 
error;  i.e.,  that  of  defining  the  density  function  of  electrons  along  the  ray 
path.  Alternate  approaches  to  this  problem  have  been  considered  as  follows. 

Assume  for  the  moment  that  the  path  length  error  is  governed  by  a  density 
function  of  electrons  which  have  only  a  vertical  variation.  The  pertinent 
elemental  path  geometry  is  as  shown  below. 


JL 

sin  0  ■  j  0  »  elevation  angle 

as 

ds  »  dh/sin  0  -  dh  CSC  0 


and  equation  (369)  becomes: 

K 

AR  -  —  J  N(h)  CSC  0  dh  (370) 

where  H  *  height  between  source  and  user . 

Since  the  ionosphere  introduces  bending  of  the  ray  along  the  energy  path 
it  is  really  more  accurate  to  express  equation  (370)  as: 
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if 


N(h)  CSC  6(h)  dh 


(371) 


since  CSC  6(h)  will  be  a  varying  elevation  angle  as  the  wave  progresses  along 
the  ray  path  due  to  refraction. 


The  integral  in  equation  (371)  is  simplified  by  defining  a  mean  equiva¬ 
lent  value  for  the  function 


^CSC  6(h)^ 


CSC~&„ 


0R  -  reference  altitude  angle 


f* 

h  J 


N(h)dh 


(372) 


The  term  J  N(h)dh  is  defined  as  the  integrated  density  profile  of  a 
vertical  column  and  in  units  it  is  expressed  as 


electrons/meter  « 


N(h)dh 


I  -  VERTICAL  ELECTRON  CONTENT 


N(h)  dh 


The  term  I  can  be  visualized  as  the  number  of  electrons  contained  in  a 
vertical  column  whose  cross-sect ional  area  is  one  square  meter: 

s - Iv  -  eiectrons/m2 


1  meter 


1  meter 


In  some  literature  the  integrated  density  of  the  vertical  column  is 
given  the  name: 


l  ■  TOTAL  ELECTRON  CONTENT 


I 


By  way  of  summarizing  it  is  possible  to  state 


I 

v 


N(b)dh 


H  * 


r 

J  N(h)  CSC  0(h)  dh 
cscTR 


(373) 


Note  that  I 

v 


CSC  0„  *  I  =  total  electron  content  in  slant -range  column. 
K  s 


The  utility  of  defining  I  =  total  electron  content  is  that  soundings 

of  the  ionosphere  at  reference  locations  canAeasily  establish  the  empirical 
value  of  the  vertical  electron  content.  Or  I  can  be  obtained  as  a  physical 

measurement  using  dual  frequency,  faraday  rotatiop  or  ionosonde  signals. 
Hence  much  information  and  data  exists  to  define  I  about  the  earth's 
surface. 


Using  the  concept  of  a  mean  equivalent  equation  for  the  CSC  0R,  we  can 
write  equation  (371)  as: 

AR  =  I  CSClL  (374) 

V  I\ 

A 

where  I  =  estimated  or  measured  total  electron  content 


CSC  9r  ■  reference  value  of  mean  equivalent 
and  we  know 


A 

cscTr 


H 

J  N(h)  CSC^Q(h) dh 


(375) 


Examination  of  equation  (375)  points  out  the  problem  of  utilizing 
equation  (374)  in  establishing  the  mean  equivalent  CSC  0„  by  knowing  the 

K 

entire  profile  and  path  length  models  --  which  are  very  difficult  to  measure 
in  real  time.  The  solution  to  the  problem  is  to; 
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(a)  Define  a  model  for  N(h)  as  a  function  of  altitude 

(b)  Execute  a  ray  tracing  program  and  determine  the  value  of 

vs  0. 

3  4 

Two  reference  sources  *  have  carried  out  the  above  steps  and  the  data 
are  presented  in  Figure  39  as  a  function  of  the  elevation  angle  0q  which 

defines  the  LOS  between  the  emitter  and  user.  This  function  has  been 
defined  alternatively  as  either  (a)  the  obliquity  factor,  or  (b)  the  ray- 
path  length  adjustment. 


Several  numerical  approximations  exist  for  calculating  the  "obliquity 
factor;"  two  of  these  are: 


1/2 


CSC  0_  =  CSC  (0  2  +  10Z) 

K  O 

=  CSC  (0  2  +  20. 31) 


1/2 


[Ref  5] 
[Ref  6] 


For  comparison  these  approximations  were  calculated  (Table  LXXXVI)  and  the 
latter  function, 


CSC  v/a2  +  20. 32 
0  in  degrees 

is  plotted  in  Figure  42  to  show  its  substantive  agreement  with  the  Hughes 
ray  tracing  data.  The  TRW  approximat ion ^  gives  a  very  large  adjustment 
factor  at  low  angles  and  is  rejected  for  this  reason  as  not  agreeing  with 
available  data. 


The  suggested  calculation  for  the  ionospheric  delay  compensation  term 
is  thus  given  as 


where 


and 


AR  -  I  CSC  ^6  2  +  20. 32  (376) 

^4  V  v  O 

K  =  1.31  x  10'16 

0  *  LOS  elevation  angle,  degrees 

o 

A  2 

I  -  estimate  of  total  electron  content  in  electrons/meter 
v 

f  =  carrier  frequency,  6Hz 
AR  =  feet. 
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TABLE  LXXXVI  CALCULATION  OF  CSC  0R 


(a)  TRW  Model 

e 

/e2+io2 

Sin(  ) 

CSC(  ) 

0 

10° 

0.1736 

5.8 

10 

14.4 

0.25 

4.0 

20 

22.6 

0.38 

2.6 

30 

31.3 

0.52 

1.4 

40 

41.0 

0.656 

1.5 

50 

51.0 

0.777 

1.3 

60 

61.0 

0.874 

1.15 

70 

70.8 

0.944 

1.06 

80 

80.6 

0.987 

1.01 

90 

90.5 

1.0 

1.0 

(b)  Aerospace  Model 

0 

20.3 

0.347 

2.9 

10 

22.6 

0.384 

2.6 

20 

28.5 

0.477 

2.1 

30 

36.2 

0.59 

1.7 

40 

45.0 

0.707 

1.42 

50 

54,0 

0.809 

1.24 

60 

64.0 

0,895 

1.12 

70 

73.0 

0.956 

1.04 

80 

82.5 

0.99 

1.0 

90 

90.0 

1.0 

1.0 

Obliquity  or  Slant  Ray  Path  Adjustment  Factor 


'  JPL  ray  tracing 
using  Chapman 
model  atmosphere 


•Hughes  Aircraft  ray  tracing 
.using  extended  Chapman 
with  diffusion  model  for 
upper  layers 


O  Da*a  points  calculated 
with  simple  model  of 

cscVe*  +  20. 32 


Source  of  Data:  Rockwell  International  Corporation 


0  20  30  40  50  60  70  80  90 

Elevation  Angle  (6  in  degrees) 

Figure  42.  Graphical  Function  for  CSC0B 


Note  that  this  approach  does  not  employ  any  consideration  of  a  lateral 
gradient  in  the  electron  density  but  that  this  limitation  can  be  easily 
overcome  when  better  ray  tracing  information  is  provided  simply  by  altering 
the  constant  term  under  the  square  root  sign. 

The  calculation  of  the  total  electron  content  depends  upon  a  form  of 
deterministic  behavior  which  is  a  function  of; 

(a)  Time  of  day 

(b)  Time  of  the  year 

(c)  Phase  of  the  solar  cycle 

(d)  Geographical  latitude  of  signal  traversal. 

From  a  software  concept  for  aircraft  navigation,  the  compensations  for 
time  of  day  and  for  latitude  are  of  primary  interest  for  real-time  calcula¬ 
tions.  Simple  seasonal  and  solar  cycle  compensations  can  also  be  incor¬ 
porated  within  the  software  for  additional  flexibility. 

The  average  value^  of  total  electron  content  for  a  vertical  column  is: 

17  2 

Iv  *  10  electrons/meter 

The  variation  about  this  average  value  can  be  at  least  as  large  as  an  order 
of  magnitude  in  either  direction  due  to  the  effects  of  time  and  location 
variability. 

A  portion  of  1^  can  be  compensated  for  the  daily  time  variation  or 

diurnal  effect  as  a  function  of  time,  or  more  precisely  ar  a  function  of  the 
location  of  the  sun.  The  first  form  of  time  compensation  considered  is 
defined  as; 

fj  *  A  +  ^  (0  <  ±  £  12  hours) 

-  B  +  ^p(t-12)  (12  S  1  s  2*  hours) 

This  is  a  linear  function  of  time  which  is  monotonic  up  to  high  noon 
from  a  night-time  low  level  of  A.  The  peak  level  B  is  reached  at  high  noon. 
For  data  plots  considered,  A  is  about  4  x  10*°  and  B  is  about  3  x  10^  with 
deviations  around  these  values  of  about  a  factor  of  3.  The  difficulty  with 
this  linear  triangular  function  is  that  its  symmetry  around  noon  does  not 
comply  with  the  natural  phenomena. 

A  more  appropriate  function  would  be  one  that  is  asymmetric  with  a  low 
value  at  sunrise  and  a  peak  in  the  late  afternoon.  The  linear  gradient  of 
the  late  afternoon  decrease  is  also  greater  than  that  of  the  early  morning 
growth  from  the  night-time  value. 
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The  restriction  to  a  linear  functional  expression  with  time  should  be 
reexamined,  and  in  fact  has  been  in  several  new  investigations  which  have 
formulated  the  following  nonlinear  functions  for  diurnal  variation. 

g 

The  suggested  method  proposed  by  a  Stanford  Electronics  Lab  study 
is  to  establish  a  Fourier  series  representation  to  describe  the  total 
electron  content  or 


Iv(t)  =  ao  +  JJV"  kT  +  \th  8ln  kT| 

where  T  =  yy 

The  coefficients  for  such  a  series  representation  are  themselves  func¬ 
tions  of  the  day  of  the  year,  d,  and  the  solar  activity  index,  s.  These 
functions  have  the  form  of  power  series  expansions  modifying  a  Fourier 
series  with  yearly  harmonics. 

The  generation  of  about  13  coefficients  was  round  to  be  sufficient  for 
describing  a  each  day  at  a  specific  reference  location  where  data  is  being 
observed  andncollected.  Since  such  locations  are  limited  and  unique,  the 
problem  of  defining  the  total  electron  content  some  distance  away  from  the 
reference  location,  but  still  within  its  region  of  correlated  occurrence  , 
is  accomplished  by  defining  an  expansion  with  a  so-called  domain. 
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APPENDIX  XIV 


RESIDUAL  PROPAGATION  ERROR  MODELING 


This  appendix  discusses  the  Kalman  filter  modeling  of  propagation  errors 
which  remain  after  closed-form  error  compensation. 


1.  SPATIAL  MODELING 

The  combined  effect  of  residual  propagation  delays  caused  by  the 
troposphere,  ionosphere,  and  multipath  effects  may  be  described  by  an  error 
term  of: 


6(f)  =  propagation  delay 

At  any  given  location  in  the  spatial  domain  of  interest,  this  propaga¬ 
tion  delay  is  characterized  as  a  random  variable  and  is  described  in 
statistical  terms,  one  of  which  could  be  the  mean  square  value  of  the  delay 
error  or: 

E  [6®(x)50(x)]  »  a2 

This  mean  square  term  is  defined  over  the  entire  extent  of  the  spatial 
variable  x  and  it  is  also  possible  to  state  that  at  any  location  that  is 
specifically  defined,  such  as  x  =  xq, 

E  [6®(xq) b<f.(xQ) ]  =  a1 

We  know  from  observation  of  the  propagation  delay  due  to  variability  of  the 
dynamics  governing  the  troposphere,  ionosphere,  and  multipath  that  the  delay 
error  is  variable  in  the  spatial  dimension,  x,  and  that 

6j(x)  ^  6 d(xo) 

The  statistical  manner  in  which  we  describe  this  variability  is  by- 
defining  the  expected  value  of  the  product: 

E  T6c(x)6<J(xo)]  -  R(Ax)  (378) 

where  Ax  *  x-x  and  R(  )  ■  autocorrelation  function, 
o 

The  biggest  difficulty  with  the  approach  used  to  this  point  is  that  we 
do  not  have  any  information  available  to  describe  the  analytical  or  empirical 
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form  of  the  autocorrelation  function,  since  global  autocorrelation  data  has 
not  been  developed  to  date.  In  the  face  of  such  ignorance,  let  us  stipulate 
that  possibly  nature  has  done  the  following: 


R(Ax)  =  cr2 


2  2 


Kl^  +  ^2  CXp  (“lAxl*d"^ 


where  K^a*"  =  fixed  bias  variance 
2  2 

<7  =  distance  variable  variance 

d  =  correlation  distance  in  feet. 
Note  that  we  scale  the  constants  such  that 


2  2 
L  K  =  1 

i  n 

n*l 


(J79) 


The  assumed  autocorrelation  function  states  two  main  ideas: 

(a)  A  fixed  portion  of  propagation  delay  is  to  be  expected  given  by 

2  2 

the  variance  term  O  . 

(b)  A  portion  of  the  propagation  delay  decorrelates  as  an  exponential 
function  of  distance,  d,  away  from  some  specific  location.  (This 
assumption  is  not  backed  up  by  any  experimental  data  but  evalua¬ 
tion  of  random  Omega  propagation  variations  indicates  that  such 
an  isotropic  diffusion  does  seem  to  occur  for  the  mean  square 
value  of  delay.) 


The  approach  to  be  followed,  given  that  R(Ax)  is  known,  will  now  be 
developed  and  can  utilize  either  the  assumed  function  shown  in  equation 
(379)  or  simply  leave  R(Ax)  to  be  defined  as  a  general  autocorrelation 
function;  its  specific  form  is  not  critical  to  the  ensuing  development. 

Incidentally,  some  mention  should  be  made  at  this  point  of  the  effect 
on  the  delay  error  of  the  geometric  orientation  of  the  line  of  sight.  This 
variability  does  in  fact  determine  the  mean  square  value  of  the  delay  and 
it  could  be  stipulated  that  R(Ax)  is  really  functional  in  the  line-of -sight 
angle,  denoted  as  0,  so  that  a  spatial  autocorrelation  is  really  denoted  as: 


R(Ax) ,0)  ■  multivariable  function 
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For  a  fixed  geometric  orientation,  or  0  -  0q,  the  multi-varied  function 

reduces  to  single  dimensionality  and  so  one  should  think  that  the  further 
discussions  are  valid  for  a  specific  geometric  orientation  which  is  always 
employed  regardless  of  specific  spatial  location. 


Since  several  speculative  assumptions  have  already  been  made,  it 
seems  reasonable  to  mention  here  that  the  geometric  variability  is  probably 
most  evident  in  the  constant  and  is  probably  of  the  form 


and 


R(Ax,0)  =  a2 
Kl<0>  "  Ko 


1^(0)  2 

CSC  0 


exp  ( - 1  Ax |  •d"*) 


Some  dependence  of  on  0  also  may  exist,  but  is  probably  negligible. 

2.  EFFECT  OF  MODEL  CORRECTIONS 

The  basis  for  every  known  form  of  propagation  delay  correction  is  to 
utilize  a  model  of  the  delay  effect  and  to  apply  the  model  term  as  a 
correction.  Generally  the  model  is  said  to  be  an  exact  evaluation  of 
6i(xQ)  at  the  location  xq,  or  at  best  a  very  large  part  of  it,  so  that  we 

can  now  formulate  the  residual  error  at  any  location  as: 


A®(x)  -  6tf(x)  -  6®(xq) 

(380) 

where 

A 

6c(xQ)  -  6 #(xq)  +  n6j(xo) 

or 

4*(x)  «  6 $(x)  -  6c(xq)  -  n6$(xo) 

(381) 

where 

n  *  fractional  part 

The  use  of  an  error  term  in  the  correction  which  is  a  fractional  part 
of  the  original  correction  itself  seems  to  be  justified,  since  generally  the 
models  are  exact  in  terms  of  functional  relations  but  are  in  error  by  know¬ 
ledge  of  a  multiplicative  constant  of  the  function. 

Next  to  be  determined  is  the  autocorrelation  for  the  residual  error  in 
the  propagation  delay  due  to  the  correction;  i.e.,  the  expectation  of: 
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fl 


E  [A0(x)A0(x)]  -  R.(Ax)  ■  residual  autocorrelation 


Substituting  produces: 


Ra(Ax)  -  E  |60(x)  -  60(xo)  -  nd^Cx^j2! 

E  (§0(x)  -  (n+l)60(xQ))2  J 

E  60(x)2  -  2(n+l)60(x)60(xo)  +  (n+l)  260(xq)2 
E  |{>0(x)2  -  2(tvfl)E  60(x)60(xo)  +  (n2+2n+l)  e|6®(xo)2 


(382) 


Using  (377)  and  (378),  we  can  write: 

y«)  -  «WkV  exp  <-ito|d’1)|  +  <»W>°2 


-  a  \ 


2+2n+n2  -  (2n+2)  K^+K^2  exp  ( 


-| Ax| d-1)  j 


(383) 


The  results  of  equation  (383)  have  several  interesting  aspects.  Using 
(383),  assume  that  n  -  0,  which  means  that  an  exact  correction  model  is 
employed  for  the  specific  point,  x  ;  then  the  residual  autocorrelation 
function  is: 


R^(Ax)  ■  a^^j^2*!^2  exp  (-|&x|‘d-1)  j 

■  |  ^2ct2-2K12ct2  ^  -  2K2<72  exp  (-|&x|*d"1) 


(384) 


The  above  result  states  that  the  residual  has  a  bias-like  variance  or 
mean  square  error  of 


2a2-2K12a2  -  ^2(k22) 

R^(Ax)  -  2a2(K22)  jl  -  exp  (-Ux|d"1) 


(385) 
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The  result  given  in  (385)  can  be  interpreted  as  a  general  result  for  any 
given  form  of  correlation  process  that  may  occur  other  than  exponential; 
only  the  form  of  the  subtracted  portion  is  altered,  so  that  in  general  for 
n*0  we  have; 

R a(Ax)  *  2a2(lC22 

where  R ^(Ax)  ®  general  normalized  autocorrelation  function.  • 

Again,  reviewing  equation  (383),  consider  that  if  the  distance  variable 
correlation  process  does  not  exist  but  that  n^O,  the  result  will  then  be 


)f 


1  -  Rn(Ax) 


but 


R^(Ax) 


a2  2+2n+n2 


-  (2n+2)Kx2 


since 


0 


(386) 


2  2 

so  R^(Ax)  -an 

Hence  the  bias-like  portion  of  the  residual  error  simply  scales  as  a  fraction 
of  the  original  mean  square  variance  by  which  the  correction  estimate  is  in 
error. 


The  spatial  autocorrelation  model  given  in  equation  (383)  thus  satis¬ 
fies  several  specific  end-point  conditions  and  also  is  general  enough  to 
accommodate  more  definitive  model  alterations  as  data  becomes  available. 

Note  that  the  result  of  (383)  is  quite  different  from  the  development  given 
in  the  previous  Multilateration  report  (AFAL  TR-72-80) .  The  only  signifi¬ 
cant  alteration  which  may  have  to  ba  applied  to  the  development  is  to  employ 
a  spatially  oriented  diffusion  process  in  two  spatial  dimensions  rather  than 
the  Isotropic  one  with  radial  distance  utilized  in  this  analysis. 


3.  TEMPORAL  MODELING 

The  time  variations  of  the  residual  propagation  delays  caused  by  the 
combined  effect  of  the  troposphere,  ionosphere,  and  multipath  probably  con¬ 
sist  of  several  time-shift-dependent  functions  which  define  the  time  auto¬ 
correlation  process  as; 
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E[6$(t)60(t-K)] 


(387) 


and 


where 


R(t) 


R(t)  ~  a2 


a  n 

CL  +  C2  exp  ( - 1  T 1 3) 


2 

+  £  C.  C0S(j-2)  cut 
j-3  J 


Ci)*  angular  rotation  rate  of  earth 
t  -  correlation  time  variable 
0  ■  reciprocal  time  constant 


The  basic  periodicity  implied  by  the  above  is  a  24-ho  n  variation  due 
to  the  diurnal  changes  caused  by  the  sun,  with  the  higher  ouJer  harmonics 
being  due  to  improper  functional  modeling  of  the  daily  changes  which  occur 
in  the  troposphere  and  ionosphere.  Note  again  that 


4.  COMBINED  STATISTICAL  ALGORITHM 

With  both  the  spatial  and  temporal  propagation  errors  defined,  it  is 
possible  to  combine  both  of  the  autocorrelation  functions  to  describe  the 
complete  error  statistics.  The  assumption  that  spatial  errors  are  not  cor 
related  with  the  temporal  errors  translates  mathematically  into: 


R^Ax.t)  -  R^(4x).R^(t) 


(388) 


Using  the  results  of  (383)  and  (38/),  it  is  possible  to  write 


R^(4x,t)  -  a 


(2+2n+n  ) -(2n+2) 

l  ‘ 

Cj  +C2  exp  (-  M*c)+  E  C  ‘  cos(n-2)ur 

n»  3 


K1i+K2/  exp  (-i Ax| .d"1) 


I 

I 


This  correlation  process  can  be  broken  up  and  rewritten  in  several  terms, 
with  the  distance  correlation  converted  to  a  time  correlation  by  assuming  a 
constant  velocity  of  movement. 
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Historically,  vehicle-borne,  radio-hybrid  navigation  system  software 
has  too  often  been  designed  around  preselected  navigation  hardware  on  an 
ad  hoc,  system-by-system  basis.  In  these  developments,  little  attention 
has  been  paid  to  the  inherent  physical  and  functional  commonality  which 
underlies  much  of  this  superficially  quite  different  software.  This 
report  documents  the  methods,  and  the  very  promising  results,  of  the 
second  phase  of  a  software  development  effort  directed  at  identifying 
and  specifying  a  standardized,  modular,  flexible,  radio-hybrid  navigation 
system  software  processor. 

The  machine-and-language-independent  (MLI)  processor  specification 
which  has  in  particular  been  developed  to  date  has  been  designed  so 
that  --  with  appropriate,  minor,  system-specific  tailoring  --  it  can 
serve  as  the  basic  specification  for  the  navigation  software  development 
for  any  specific  system,  within  a  wide  range  of  navigation  hardware 
equipment  configurations  and  mission  requirements.  These  currently 
include  any  combination  of  radio  (LOS  or  earth  mode),  inertial,  AHRS,  • 
and  CADS  navigation  equipments,  as  well  as  the  requirements  associated 
with  most  military  and  civil  aircraft  missions  and  usages.  In  addition, 
the  MLI  processor  has  been  carefully  structured  to  allow  for  easy  accom¬ 
modation  of  additional  navigation  hardware  processing  requirements.  (Continued) 
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The  second-phase  effort  used  as  its  point  of  departure  and  develop¬ 
mental  framework  the  basic  guidelines,  concepts  and  algorithms  established 
in  the  initial  phase.  These  include,  in  particular,  the  exclusive  use  of 
vector-matrix  algorithm  formulations,  processor  organization  into  basic, 
building-block  function-  and  hardware-specific  modules  and  submodules, 
the  use  of  a  single,  mission-phase  switchable,  computational  reference 
frame,  and  the  use  of  partitioned,  modularly  organized  Kalman  filtering 
techniques.  The  overall  second-phase  effort  itself  consisted  of  two 
main,  more  or  less  sequential  developments:  (a)  the  extension  and  re¬ 
finement  of  the  MLI  processor  capabilities  beyond  its  first-phase  level, 
and  (b)  the  initial  development  of  a  specialized,  higher-order  language 
navigation  program  using  the  MLI  processor  specification  as  a  basis. 

The  improvements  of  the  MLI  processor  accomplished  in  the  second 
phase  included  (a)  extension  of  its  navigation  hardware  applicability 
to  allow  use  of  cheaper  AHRU/CADS  equipment,  either  in  lieu  of  or  as 
a  backup  to  an  IMU;  (b)  further  development  and  refinement  of  a  novel 
and  promising  radio-autonomous  navigation  technique;  (c)  extension  and 
refinement  of  processor  and  navigation  equipment  initialization  and 
alignment  techniques;  (d)  development  of  a  completely  partitioned  and 
modularized  Kalman  filter;  and  (e)  development  of  a  complete  set  of 
processor  mode  control  and  switching  logic  specifications.  In  particular, 
one  of  the  initialization  algorithms  developed  is  a  new  and  powerful  one 
which  allows  undegraded  Kalman  filter  use  of  radio  pseudoranging  measure¬ 
ments,  despite  farge  LOS  directional  uncertainties.  Further,  the  Kalman 
filter  partitioned  modularity  was  achieved  without  artificial  (and  per¬ 
formance-degrading)  decoupling  of  interpartition  system  error  dynamics. 

Time  and  money  constraints  permitted  development  of  the  specialized 
FORTRAN  IV/IBM  370  processor  program  only  co  a  very  limited  stage.  Specif 
ically,  all  the  principal  navigation  modules  required  for  a  single  assumed 
LOS/inertial  navigation  hardware  configuration  and  navigation  mode  of 
operation  have  been  programmed  and  checked  out  (for  fixed  inputs  only); 
no  mode  switching  or  control  modules  have  been  programmed.  However,  even 
this  limited  level  of  development  was  intended  (and  has  ser-ed)to  accom¬ 
plish  two  purposes.  First,  it  provided  a  learn-by-doing  vehicle  for  the 
broadly  experienced  programmer  assigned  the  task,  to  assay  the  viability 
of  the  MLI  processor  specifications  from  the  standpoint  of  real-time  pro¬ 
gramming  in  either  an  HOL  or  a  machine-specific  language.  The  preliminary 
conclusions  reached  in  this  regard  are  that  the  MLI  specification  provides 
the  programmer  with  an  extremely  flexible  and  easily  modifiable,  but 
standardized  approach  to  programming  real-time,  multisensor,  Kalman  (or 
non-Kalman)  navigation  systam  software  for  any  airborne  digital  computer. 
In  addition,  it  places  overall  program  efficiency  and  balance  (with  regard 
to  execution  time  and  memory  requirements)  much  more  completely  under  the 
control  of  the  programmer  than  traditional  types  of  specification. 
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The  second  purpose  accomplished  lies  in  the  fact  that  the  programed 
modules  thus  far  developed  constitute  a  nucleus-in-being  for  further  devel 
opment  of  either  a  processor  evaluation  simulation  program  on  the  one  hand 
or  a  standardized,  real-time  HOL  master  navigation  program  for  subsequent 
machine-specific  translation,  on  the  other. 
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